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1 INTRODUCTION 

This report provides detailed software documentation of the digital 
computer program FINOS (Fault Inferring Nonlinear Detection System) 
version 3.0. FINDS is a highly modular and extensible computer 
program designed to monitor and detect sensor failures, while at the 
same time providing reliable state estimates. In this version of the 
program the FINOS methodology is used to detect, isolate and 
compensate for failures in simulated avionics sensors used by the 
Advanced Transport Operating Systems (ATOPS) Transport Systems 
Research Vehicle ( I SR V ) in a Microwave Landing System (MLS) 
enviornment. It is intended that this report serve as a programmers 
guide to aid in the maintenance, modification, and revision of the 
software. 

Throughout this manual we have assumed that the reader has read and is 
familiar with the contents of the following reports: 


1. FINDS: A Fault Inferring Nonlinear Detection System - User's 

Guide, NASA CR-172199, September 1983. 

2. A Fault Tolerant System for an Integrated Avionics Sensor 
Configuration, NASA CR-3834, 1984. 

3. An Aircraft Sensor Fault Tolerant System, NASA CR-165876. 
April 1982. 

The primary goal of this manual is to provide in depth documentation 
of the current version of the FINOS software. To accomplish this 
goal, detailed descriptions are provided for the program's modules 
(functions, and subroutines) and their internal data structures 
(common blocks) developed by BBN. In addition, the contents and 

purpose of each disk file will be examined along with the steps 
required to rebuild the library and executable tiles used by FINDS. 
Detailed information about the program's external data structures 
(input and output files), as well as information about the program's 
overall structure and intended usage (from a users point of view) can 
be found in [11, and therefore will not be covered in this report. It 
should be clearly noted that NOT ALL functions and internal data 
structures used by FINOS will be described in this report — instead 
only those which pertain to the simulation independent portion of the 
program wi 11 be considered. This approach was taken because the 
simulation environment in which FINDS operates was originally 
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developed and supplied by NASA-LRC, and therefore it was felt the 
emphasis of this document should only be on the newly developed 
software. 

A secondary goal of this work is to provide a convienent mechanism for 
documentation information contained herein to be maintained and 
improved upon. Some of the problems associated with writing a 
programmers or users guide for a developmental computer program, such 
as FINDS, is that it a) is never quite comprehensive enough, and bi is 
obsolete soon after it is printed. This is true in part because 
developmental programs are never quite stable (i.e. they are 
constantly being modified as new provisions are added, or as “bugs" 
are found), and in part because incremental (i.e., as modules are 
written) documentation is seen by many to be both time consuming and 
fragmented - therefore it is not always done. This clearly confounds 
the development process itself, since only a few people know the 
"inner workings" of the program. In an effort to help alleviate some 
of these inherent problems, we have written this programmer's manual 
in such a way that it can be re-created semi-automatical 1 y from 
specially commented source code and text files. The goal was to make 
it easy to incorporate changes which occurred since the last time a 
manual was created. To accomplish this, special command files and 
programs were created to generate files which could be processed by 
the Digital Standard Runoff text formatting program. In addition, all 
the figures and tables used in the manual were generated on an Apple 
Lisa personal computer (using LisaDraw software) - so they too can be 
easily modified and re-generated to account for changes to the code. 

The organization of this report is as follows: Chapter 2 consists of 
a comDrehensi ve overview of the FINDS software, along with 
installation instructions. Chapter 3 provides detailed descriptions 
of the FINDS program modules, as well as an overview of some 
notational conventions used in the report. The internal data 
structures and a summary of the indexing schemes employed can be found 
in Chapter 4. Appendix A gives a list of specific hardware and 
software requirements (including a list of all supplied software). 
Appendix B contains the "rules" for formatting source files and a 
description of how this manual can be automatically re-generated. As 
a further aid, a cross-reference list of all file names, common block 
names, module names, and other key words documented in this report can 
be found at the end of the report. 
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The following suggested reading of the manual is encouraged: 
General information and installation: 

1. 2, Appendix A 
Complete reading: 

1,2,3. 1,4.1, remainder of Chapter 3, and 4, Appendix A, and 
B. 


Appendix 
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2 SOFTWARE OVERVIEW AND INSTALLATION DETAILS 

This chapter describes how the software is organized from the vantage 
point of the VAX 11/780 operating system. A user's perspective on the 
functional organization and other aspects of the FINDS software and 
its' utility programs are provided in C1J. The chapter is organized 
in the following fashion: Section 2.1 gives an overview of the 
delivered software by reviewing the contents and intended purpose of 
each file supplied. (Note: For quick reference, Appendix A also 
provides a brief summary of these files.) Section 2.2 describes the 
steps nessesary to install (or rebuild) each of the programs. 
Automatic re-generation of the programmers guide is covered separately 
in Appendix B. 


2.1 Software Overview 

This section describes the contents and intended scope of each of the 
disk files which comprise FINDS and its associated utility programs. 
A complete list of all the delivered software, as well as the specific 
hardware requirements, are described in Appendix A. Detailed 
descriptions of the individual modules contained in each file can be 
found in the next chapter. 

It is convenient to assume that the operational software is stored in 
a main directory which will be called the FINDS directory. The 
organization of this directory is straightforward. There are four 
executable programs in the directory - each requiring FOR, OLB, COM, 
and/or OPT files for their creation. The four executable files are 
detailed below: 


DOC. EXE 

FINDS.EXE 

PL0TD.EXE 

PRINTD.EXE 


A program to extract specially formatted and embedded 
documentation from Fortran (or Ratfor) source 
files (see Appendix B for a description of its use). 
FINDS version J.O simulation program documented in 
this manual and in Cl]. 

Program to plot the time history output, generated by 
FINDS, on a Tektronix 4010/4014 or compatible terminal 
(see C 1 3 ) . 

Program to print the time history output, generated by 
FINDS, in tabular form on either the users terminal or 
a disk file ( see 111) . 
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The FINOS directory contains a single library file: 


FINDSLIB.OLB- Utility library built using the FINDS sources (FORTRAN 
files) . 

Several command and linker option files can be found in the FINOS 
directory. Command files (extension = COM) are used to automate the 
building and maintainence of FINOS. As will be seen in the next 
section, a by-product of using command files is that it simplifies 
transporting the software to other VAX or users sub-directories. 
Linker options files are used at link time to specify how to build an 
executable image. The command and linker ODtions files are summarized 
below: 


FINOSC.COM - 
FINOSL.COM - 
FINDSL1B.COM - 
GETOOC.COM - 


FINDSPG.COM - 

PL0T0.0PT 
PRINTO.OPT - 
FOREIGN.COM - 


Properly compiles all the FORTRAN source files which 
are used by FINDS. 

Properly links together the obiect and library files 
to produce FIN0S.EXE. 

Compiles the source files and builds the library file 
FINDSLIB.OLB 

Automatically gets the latest documentation 
from all FINOS routines (see Appendix B for 
more information). 

Automatically builds a new FINOS programmers 
guide (see Appendix B). 

Linker options file for PLOTD 

Linker options file for PRINTD 

Establishes useful logical and symbolic names 


2.2 Installation Notes 

The following steps are required to initially install the FINDS 
software: 


1. Copy all files from magnetic tape onto a suitable VAX disk 
directory using the VAX/VMS Backup utility. Let's assume 
this directory is named "finds" for the subsequent 
discussions. 


5 



FINOS Programmer ' s Manual 

SOFTWARE OVERVIEW AND INSTALLATION DETAILS 


2. Edit the file "foreign.com" and correct the directory names 
referenced so that they point to directory [finds]. 

3. Type 

$ ©foreign.com 

to install the logical names and symbols. These will be will 
be used subsequently. (This step can be made part of the 
user's login.com file if these symbols are used frequently.) 

4. Compile all FORTRAN sources: 

$ ©find sc 
$ compile plotd 
$ compile printd 

5. Create the FINOS library file f indsl ib.olb: 

$ ©findslib 

6. Create the executable files: 

$ ©finds 

$ link plotd/opt 
$ link printd/opt 

7. Generate all the required input data files required for 
running FINOS using the text editor. (See Cl] for detailed 
directions on how to create these files.) 

8. Run FINOS by typing: 

$ finds 

9. Run the graphical analysis tool PLOTD by typing: 

$ plotd 

10. Run the tabular examination tool PRINTD by typing: 

$ printd 


Once the software has been installed, incremental changes can be made 
as follows: 


1. Modify a Fortran source file. Be sure to update the embedded 
documentation. 
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2, Compile it, (e.g. $ compile filename) 


3. Update the library file (this step is required for files 
futsub.for, fvmsub.for, and fiosub.for.) 

$ update filename 


4. Re-build FINOS 
$ ©finds 


For instructions on how to generate and maintain the programmers guide 
see Appendix B. 
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3 MODULE DESCRIPTIONS 

The following subsections contain detailed descriptions of FINDS 
routines, organized according to source files (refer to Chapter 2 for 
a list of supplied files). The first subsection reviews some of the 
notational shorthand used in the descriptions. The second subsection 
contains a brief description of the contents of each file, containing 
a statement of the name of the source file, a description of the 
nature of its contents, and then a list and short synopsis of each 
subroutine it contains. The remaining subsections contain more 
detailed descriptions of each subroutine - many of which have 
companion flowcharts. Each such description contains a statement of 
the subroutine function, a sample call, and a description of the 
required arguments in the form: 

name type in, out, or inout units description 

These are followed by a list of all other routines called, all 
routines which reference it, and all common blocks used by the 
routine. Full descriptions of most of the common blocks can be found 
in Chapter 4. 


3.1 Some Notational Conventions 

In order to condense the textual descriptions and flowcharts we've 
adopted various shorthand notations. This section itemizes these 
conventions . 


In specifying the argument descriptions we've assumed the following: 


Variable type can be: 
. integer - 
. real 
. double 
. logical - 
. char 
. char*n 
. byte 

Units can be: 

. a standard 
. unitless - 


integer*4 
real *4 
real *8 
logical *4 
character*) x) 
characters 
logical*! 


engineering unit or 
no units ( i .e. a 


cardinal or pointer 
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index) 

. mixed 

various units (usually used for 
vectors, matrices, and scratch areas 

. temp 

temporary, i.e. units vary 

. string 

ASCII characters 


Arrays (matrices and vectors) are usually specified by upper case 
names. Both upper and lower case are often used to aid in 
interpreting the mnemonic used. The following shorthand notation is 
used when discussing arrays or equations involving arrays: 


A(i,j) - 
V/( i ) 

ACilc - 
ACilr 
AC i : j 3c - 

At i : j ]r - 

A*B 

a*b 


the i,j'th element of the matrix A 

the i 'th element of the linear array V 

the i'th column of the array A 

the i 'th row of the array A 

the submatrix comprised of the i'th through 

j'th columns of the array A 

the submatrix comprised of the i'th through 

j'th rows of the array A 

matrix multiplication of A and B 

scalar multiplication of a and b (Note: lower 

case usually implies a scalar variable) 


The flowcharts contained in this manual are not meant to be complete 
descriptions of the routines. Instead, they are intended to enhance 
the reader's understanding of the software's structure and to 
highlight the software techniques employed. As such, they should be 
used in conjunction with the written documentation and commented 
source code itself. For example, one particular flowchart may show, 
by detai led enumeration, how the internal data structures are used, 
whereas in an other case a top-level functional flowchart will be 
presented to highlight an important theme. 


Most of the symbolic notation used in the flowcharts are described in 
Figure 1. Notation inside subroutine boxes may contain the following: 


. the box can contain the subroutine name, 

. the subroutine name and its arguments, or 
the subroutine name and a key argument. 


As a general rule, always refer to the written documentation for the 
correct calling sequence to use. Array indexing conventions are 
described in Chapter 4. 
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V. (ENTER) J 

i 

The beginning of a process (subroutine) 



An I/O box 

performs the indicated 
input and/or output operations 



An onpage connector 

1 


- ~r 

An instruction box 
performs operations 
called for in the box 


stop ) 

(EXIT) ) 


The End of a process (subroutine) 



taken depending on the result of 
the computation Indicated in the 
box 

An offpage connector 



Subroutine box 
performs operations via the 
subroutine named in the box 



Figure 1. Definition of Flow Diagram Symbols 
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3.2 

name: 

cont: 

subr : 


name: 

cont: 

subr: 


Brief Summary Of Contents By Source File 


FMA IN. FOR 

This file contains the main simulation program which 
orchestrates the execution of FINDS. 

FINDS: (program unit) Top level simulation program 

INITAL: initializes several basic simulation quantities 
SET: initializes constants (such as conversion 

factors) used in FINDS 


FSFOI .FOR 

This file contains all the "core" routines necessary to 
implement the FINOS fault tolerant navigator and FDIR 
software. As such, these routines roughly represent 
the simulation independent, portion of the program. 

NAV - fault tolerant navigator - orchestrates the operation 
of FINOS FTN and FDIR functions 
INITG - general initialization for FINDS 

INITF - perform initialization specific to the no-fail filter 
5TARTF- start-up procedure for the no-tail fi Iter, i.e. 
choose initial conditions 

SUMIN - forms the input vector to the no-fail filter 
SUMOUT- forms the measurement vector for the no-fail filter 
GVROCR- compute compensation for the rate gyros due to 
the earth's rotation 

GTOI - compute inertial quantities from ground based' 
estimates 

CKUNST- check the no-fail filter estimates for divergence 
KALMN - executive routine to implement an extended Kalman 
filter using a bias filter decomposition 
EKFN1 - bias-free portion of the extended Kalman filter 
BIASF - bias portion of the extended Kalman filter 
BLEND - blend the bias and bias-free states and covariances 
together to form the total no-tall filter estimates 
BLGAIN- compute the blender gain 

SETISN- update a count of the current number of sensors 
used by the no-fall filter 

CHKRAO- check for switch over to radar altimeter, and 
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reconfigure the no-fail filter at switch over time 
UPDA - update the discrete state transition matrix 

UPDAB - update the discrete state transition matrix to include 

the coupling due to the biases 
UPDB - update the discrete input matrix 

UPDQ - update the discrete process noise covariance matrix 

UPDH - update the non-linear measurement function 

UPDPH - update the partial of h C x ( k ) 3 w.r.t. x(k) 

DETECT- implements a bank of detectors and likelihood ratio 
computers 

LKF - first order linear Kalman filter - used to estimate a 
hypothesized failure's level 
LRT - computes a log- likelihood ratio 
DECIDE- performs failure decision functions 
RECONF- reconfigures the FTS after failures and/or healings 
CLPSIO- collapse (expand) the no-fail filter to reflect 
failure (healing) of a sensor 
NOISR - reset elements in the no-fail filter process and 
measurement covariance matrices to reflect the 
loss (addition) of a sensor 

RESCMP- compute the expanded residuals sequence from the 
(collapsed) innovations sequence produced by the 
no-fail filter 

FILCOL- estimate colored MLS noise states (used to compensate 
the innovations sequence to account for its colored 
stati sties) 

CLPSBE- collapse (expand) the bias estimator to reflect the 
removal (addition) of a bias 

ADSTBP- adjust (manage) pointer vectors used in the bias 
estimator 

RCOV - reset the no-fail filter state estimation error 
covariance after FDI of a failure 
MINSET- check to be sure filter will remain stable after 
a candidate sensor is removed 
HEALR - monitor tailed sensors and test for healing 
AVECMP- compute the sum of the difference between two like 
sensors over the healing window 
LRTHLR- compute a LRT for the healing of a sensor at the 
end of the healer windows 

CONVRF- returns the conversion factor required to convert 

from program to user (printout) units for a particular 
no-fail filter state or sensor 
AVBIAS- computes the average measurement bias as seen by 
the no-fail filter 
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name: F6AC.F0R 

cont: This file contains routines used to simulate the aircraft 

and the guidance and control logic used in the aircraft. 
These routines were originally part of program FILCOMP. 
subr: ACEQIN- integrate the aircraft equations of motion ahead 

one simultion step 
AUTLD - auto- land control laws 
AUTTHR- compute throttle commands 

BANKTR- RNAV guidance and control outputs i.e. commands 
to guide the aircraft before AUTLD takes over 
CNTRLS- generate the control signals using either true 
(i.e. simulated) or estimated quantities 
ESTPNP- compute estimates of waypoint quantities and store 
them in EWP 

RUDDER- dynamics for the rudder servo and yaw rate damper 
SERVO - elevator and aileron servo dynamics 
STABCN- stabilizer trim control logic 

THRUSD- engine thrust dynamics (accurate above 10 degrees 
throttle setting) 

WAYPNT- compute all data for waypoint segment planning 


name: FWIND.FOR 

cont: Contains routines used to simulate the wind and gust 

environments to which the aircraft will be subjected, 
subr: BREEZE- computes shear winds, calls WINDGT to generate gusts 

and sums the wind components to form the total winds 
GROUNE- computes the effects of ground proximity - called 

ground effects - as incremental terms added to pitch, 
lift, and drag 

WINDGT- generates gust components which are added to u,v,w 
and P,Q,R terms in the aircraft simulation 
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name: F SENS. FOR 

cont: This file contains all the routines used to simulate the 

normal operation and the "failed" behavior of sensors and 
sensor sub-svstems in FINDS. All sensors contained in 
this file can be simulated with up to triple redundancy - 
except for the RSDIMU. The reader can find detailed 
descriptions on how each sensor is simulated and how to 
modify the parameters of these modules in section 3.3 of Cl], 
subr: RADALS- radar altimeter sensor module 

AIRSPS- indicated airspeed sensor module 

BMRGS - flight quality body mounted rate gyro sensors (P,0,R) 
BMLAS - flight quality body mounted linear accelerometer 
sensors (Ax.Av.Az) 

ATITGS- platform INS attitude outputs I phi .theta, psi ) 

GETMLS- microwave landing system sensor ( azimuth. elevation, 
range l 

RSIMUS- redundant strapdown IMU sensor (RSDIMU). This routine 
is an executive routine for the RSDIMU. 

IRATG1- initialization for the RSDIMU rate gyro module 
ILNaGI- initialization for the RSDIMU linear accelerometer 
module 

ILNAVl- initialization for the RSDIMU navigator module 
LINAC1- RSDIMU linear accelerometer module 
LLNAVl- RSDIMU navigation module 
RATEG1- RSDIMU rate gyro module 


name: FIG. FOR 

cont: This file contains routines used to save simulation data 

in special formats on disk files, along with routines to 
help perform this function. 

subr: SAVIT - saves FINDS time history data in the (binary) PLT 

file in a sequential, run-time user selectable fashion 
PRNTIC- print the run's initial conditions - in special 
table form - on any ASCII disk file 
FSCHED- determine, for a particular sensor, the time, tvpe, 
and level of failure if simulated 
CHkFL - check if a sensor is scheduled to fail in the run. 

and return the time and tvpe of the scheduled failure 
FLEVEL- determine the failure level of a scheduled failure 
OUTDAT- print out a one line message followed by a formatted 
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printout of a scaled vector (scaled by a supplied 
conversion factor) 

TLOUT - print an "event" in a special coded form (described in 
section 4.2 of C1J) in the time line (.TIN) file 


name: 

cont: 

subr: 


FUTSUB.FOR 

(his file contains a collection of "utility" routines 
which are generally specific to the FINOS program 
ABSLIM- absolute limit - i.e. two-sided limit about zero 
ACCVEL- compute G-frame velocity and acceleration terms 
ROTATV- rotate inertial pos. and vel. vector to the E-frame 
ROTMAT- computes various frame transformation matrices 
RUNGK3- performs Runge-Kutta integration 
RUNWAY- computes A/C position and velocity vectors 
relative to G-frame 

SETUM - sets a scalar into all elements of a vector 
VECM - multiplies two vectors - element by element 
VECS - multiplies two vectors - element by element and 
increments the first 
VECSUM- adds to vectors 

MATV3 - multiplys a 3 by 3 matrix times a vector 
MATTV3- multiplys the transpose of a [3 x 31 matrix 
times a vector 

MATMUL- multiplies a matrix times a vector 
MOVUM - equates two arrays 
0GATI0- prints out a double precision matrix 
SUMMER- computes the conditional average sum of an array 
ASUMER- computes the conditional average sum of an array 
MAXMIN- locates the maximum and minimum elements 
in an array 

MAXMINS-same as MAXMIN - except single precision version 
MXMN2 - same as MAXMIN - except elements are conditioned 
on a non-zero element in a second array 
VECHG1- collapse or expand a vector 
MATCG2- collapse or expand a matrix 
IMTCG2- adds or deletes rows (columns) of matrices 
PNTINV- pointer vector inverse 

LIMVAL- vector limiter for symmetric limits about zero 
LIMVL2- limiter for anti-symetric two-sided limits 
NOISEG- generates samples from a normal distribution 
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with zero mean and unity variance 
BARN1 - genertes samples from either a gaussian or a 
uniform distribution 

GAUSS - gaussian random number generator 
UNIFRM- uniform random number generator 
NAMFIL- forms a file name with a fixed name and various 
extensions 


name: FVMSUB.FOR 

cont: This file contains routines which perform operations on 

vectors and matrices. Unless explicitly stated, all 
routines operate on double presision quantities, 
subr: BUBBLE- perform bubble sort on an arrav of integers 

DOT - compute dot (or inner) product between two column 
vectors 

D0T2 - computes dot product of two row vectors 
D0T3 - computes dot product between a row and a column 
vector 

VADD - increments a given vector by a second vector 
VADD1 - increments a given row vector by a second row 
vector 

VSCALE- sets one vector equal to another times a scale 
factor 

SEQNCE- initializes an integer array as [1,2, ...N3 
INSRTN- maintains a pointer vector (integer) with 
unique entries 

VECNULS-initializes a column vector to zero (single 
preci sion ) 

VECNUL- initializes a column vector to zero (Double 
preci sion ) 

SWAP - Swaps a row, column, or diagonal between two matrices 
VNWT1 - multiplies a vector by a matrix Y=AX 
VWT2 - computes the vector matrix product sum Y=Z+AX 
GMINV - computes the inverse or generalized Penrose 
inverse of a matrix 

MMUL - computes the matrix product Z=XY (with sparseness 
test on X) 

MMUL2 - computes the matrix product Z=XY (with 
sparseness test on Y) 

MAT1 - computes the matrix product Z=XY 
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matia - computes the matrix product Z=*f (l can equal it 

MAT2 - computes the matrix product Z=XY' (for Z 
symmetric ) 

MAT3 - computes the matrix product Z=XYX' 

MAT3A - computes the matrix product Z=X'YX 
MAT4 - computes the matrix product Z=X'Y 
MATS - computes the matrix product Z=XY' (with 
sparseness test on Y) 

MAT6 - computes the matrix product Z=X Y' (with 
sparseness test on Y, and Z symmetric) 

MADD1 - adds two matrices 

MADDI - adds a scaled matrix plus a scaled identity matrix 
EQUATE- equates one matrix to another 
MATNUL- initializes a matrix to zero 
MSCALE- scales a matrix by a scalar constant 
TRANS1- computes the transpose of a matrix 
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3.3 Detailed Descriptions Of FINDS Routines 


3.3.1 Documentation For File: FMAIN.FOR - 

name: FINDS - (Main Program) 

Detection System" 

func: This program unit is responsible for coordinating the run-time 

operation of the program, fhe overall purpose and use of the 
program - from a users point of view - is documented in detail 
in CIJ. To show the overall scope and flow of the program a 
functional flow diagram is shown in Figure 2. Three stages of 
the program are evident in this figure: 

* an initialization stage - designed to initialize all 
variables and routines and to establish all disk file 
interactions 

* a basic simulation loop - whose purpose is to continually 
compute the current control signal over the next simulation 
interval, integrate the A/C equations of motion, simulate 
the A/C and sensor subsystems, and exercise the FIADS FDI 
and estimation algorithms until a stopping criteria has 
been satisfied. 

* a termination stage - once the simulation loop has 
satisfied its stopping criterion, the program is gracefully 
terminated . 

Figure 3 provides a much more detailed and annotated flow 
diagram which clearly shows how program FINDS operates, 
ref: ACCVEL, ACEQIN, AIRSPS, ALTYP, ATITGS, AUTLD, AUTLDI , AUTTHR , 

BANKTR, BMLAS, BMRGS, BREEZE, CNTRLS, CTEXT, GETMLS, GROUNE, 
INITAL, ISPEC, MATMUL, NAMFIL, NAV. 0PN2, PAGEFD, PRNTIC, 
RADALS, ROTATV, ROTMAT, RSIMUS. RUDDER, RUNGK3, RUNWAY, SAVIT. 
SERVO, SET, STABCN, THRUSD, TLOUT, WTHDR1 
Also from the VMS libraries: 

ASIN, CLOSE, DATAN2. DCOS, OSIN, LIB$FLT_UNDER, 

LIB$INIT_TIMER, LIBSSTAT _TIMER, OPEN, SECNDS 
comm: ALPCOM, ANGLES, ANGS, ARSTAT. ATMO, AZELRN, COEFGE, CONTRL, 

CPU, CRTE, DROP, EARTH, EGUIDE, EKF1, FC0M1, FC0M2, FILNAM. 
FLTCTL. FTITL1, GEARED, GSLOPE, GUIDE, HICOM, ICLALO, IEST, 
IM.S, INOU, IUVW, LAND, LAOUT. L0GIC4, MCONCO, MLS ALL. MLXYZ, 
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NAvINF, NWPLTi, PHILLY, PLOTS, PORT, PORN, PSIfi, OR AND, 
RGUIDE, RIOUT, RSTATE, RUNGEK. SETCOM, SIGTAU, SIMCOM, 
SNSIOT, SNSROT, SPCFOR, START, SYNC, TRANS, TURN, TURNOF, 
UPDAT, VARLAT, VARLON, VORTAC, WIND, WINDCO, WP, XOYOZO 
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Figure 3. Flow Diagram for Program FINDS (continued) 
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Figure 3. Flow Diagram for Program FINDS (continued) 
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Figure 3. Flow Diagram for Program FINDS (continued) 
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name: INITAL 

func: To initialize several program variables - mostly related 

to the guidance and control algorithms. Originally, (in 
program FILCOMP) INITAL was intended to initialize case 
independent quantities - however, since FINDS doesn't allow 
multiple cases in the same physical run, no such distinction 
is made in FINOS, 
call: Call INITAL 

args: None 

refs: None 

refby: FINDS 

comm: COEFGE, CONTRL, L0GIC4, SYNC, WIND 


name: SET 

func: To initialize various constants l such as conversion factors) 

and program flags used by FINDS. Originally, (in program 
FILCOMP) SET was intended to intialize case dependent 
quantities - however, since FINDS doesn't allow multiple 
cases in the same physical run. no such distinction is made 
in FINDS, 
call: Call SET 

args: None 

refs: None 

refbv: FINDS 

comm: ALPCOM, ANGLES, ATMO, CONTRL, EARTH, FC0M1, FC0M2, GEARLD, 

HICOM, IEST, MCONCO, NAVINF, NWPLT1, PHILLY, PLOTS, SETCOM, 
SYNC, VARLAT, VARLON, WIND, WINDCO 
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3.3.2 Documentation For File: FSFDI.FOR - 

name: NAV (fault tolerant navigator) 

func: This subroutine is an executive program which implements a 

fault tolerant navigator using the FINDS approach. It is 
responsible for initialization, synchronization, and 
execution of all the modules comprising the FTN and FDIR 
logic. Figure 4 shows a detailed flow diagram indicating 
its operation, 
call: Call NAV (Iabort) 

args: Iabort - integer out flag indicating whether to 

continue or abort the run. If labort=0 continue the 
run; otherwise abort. 

refs: CHKRAD, CKUNST. DECIDE, DETECT, FILCOL, GTOI, HEALR , INITG, 

KALMN. LIB$INIT_TIMER, LIB$STAT_TIMER, PRNTIC, RECONF, RESCMP 
SUMIN, SUMOUT, TLOUT, WAYPNT 
ref by: FINDS 

comm: CMPSTF, CNTROL, CPU, DCIDEI, DETINF, EARTH, EKBFO, EKF1, 

FC0M1, FILTRT, FLTCTL, GBLEND, IMLS, INOU, M4IN1, MAIN2, 
PHILLY, PLOTS, SIMCOM, SYSU1, SYSXBO, SYSYBO. SYSXW1, SYSX1, 
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Figure 4. Flow Diagram for Subroutine NAV (continued) 
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Figure 4. Flow Diagram for Sitoroutine NAV (concluded) 
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name: INITG 

func: Performs initialization for the FTS software. In particular, 

the no-fail filter, failure detection isolation and 
reconfiguration modules are intialized here. In addition, 
program flags and data structures are intialized which 
determine the structure of the FTS. These flags are 
modifed via namelist FILTIN, which is read in this routine. 

call: Call INITG (Ipart) 

args: Ipart - integer in flag to indicate which part of the 

intialization is to be performed. If Ipart=l all 
initialization except for determining the initial 
conditions of the NFF is performed. Otherwise the 
NFF IC's are chosen 

refs: ALTYP. BUBBLE. CONVRF, EQUATE, GTOI, IMSCLE, INITF, MTHSDLOG 

SEQUNCE, STARTF, SUMIN, SUMOUT, UPDA, UPDB 

ref by: NAV 

comm: AGMP, ARMP, ARSTAT, ASMP, CMPSTF, CNEST, CNTROL, COLFIL, 

DCIDEI, DETINF, DETSIG, DETXBI, DETYBI, EARTH, EKBFO, EKF1, 
FC0M1, FILTIC, FILTRT, FLTCTL, FTITL1, GBLENO, GRMP, HEALCM, 
HFCOM, I MLS, INITVL, INOU, LAMP, L0GCI4, MAIN1, MAIN2, MCONCO, 
MLSALL, MLSMP, MULTDT, NWPLT1, PLOTS, PSIR, RALMP, RGMP, 

RIOUT, 

SENSCM, SETCOM, SIGTAU, SIMCOM, SYNC, SYSU1, SYSX1, SYSXBO, 
SYSYBO, SYSYW1, VARLON, WIND, X0Y0Z0, YOBSRV, 


name: INITF 

func: To Initialize the EKF's measurement and process noise 

covariance 

matrices, RF1 
normalization 
as follows: 
a) process noises 
* if using the 


and QF1 respectively, and the measurement 
scaling vector Yscaie. The quantities are set 


b) 


QFl(i) = 
* or if using 
OFl(i) = 
OFl(i) = 
QFl(i) = 
measurement 
RFl(i) 


"standard" 
si gf i )**2 
the RSDIMU 
sig(17)**2 
= si g( 18)**2 
= sig( i )**2 
noises: 

= si g( i+8)**2/n 


sensor set (i.e. 
for 1=1,.. 8 
(i.e. irsdf=0); 


irsdf !=0) 


for i=l,...3 


for i=4,.., 
for i=7,8 


6 


for i=l,...8 


32 



FINOS Programmer's Manual 
Documentation For File: FSF0I.F0R 


where n=Ireplf (i+nul) i.e., the number of replications of 
a particular sensor type currently in use by the EKF. 
cl scaling vector: 

* if IYSC=0 then Yscale( i )=1 .0 for i=l,...8 

(i.e. scaling is disabled) 

* otherwise 

Yscale(i) = 1 .O/SQRTCRFH i ) 3 for i=l 8 

call: Call INITF 

args: None 

refs: None 

refby: INIT6 

comm: OETXBI. FILTRT, FLTCTL, SIGTAU, SYSU1. SYSYW1, YOBSRV 


name: STARTF 

func: To initialize the no-fail filter's state estimates and 

initial error covariance. This is accomplished as follows: 
choose the initial estimation error from a random 
distribution, s.t. 

1) XlCerr(i) = SDXic(i)*s for i=l,NX 

where s is a sample from a normal distribution with 
mean=0 and variance=l, and SDXic is a vector of expected 
standard deviations 

2) set XFl(i) = Xt-XlCerr(i) for i=l,NX 

where Xt represents the "true" or simulated value of 
XFl(i 1 

3) initialize the bias-free filter covariance, PF1, and 
the total no-fail filter (bias & bias-free) filter 
covariance, PXF1, to be diagonal matrices with diagonal 
elements; 

PFl(i,i) = PXF1( i ,i ) = SDPic(i)**2 
where SDPic is a vector of standard deviations for the 
initial filter covariance 

Note: SDXic and SDPic are in user units, therefore this 

routine also performs conversion to program units 
call: Call STARTF 

args: None 

refs: NOISEG 

refby: INITG 

comm: ANGLES, AZELRN, CMPSTF, EKF1, FILTIC, MAIN1, MCONCO, PSIR, 

ORAND, SYSX1, UPDAT, VARLON, WIND 
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name: SUMIN 

func: To provide a proper set of inputs to the no-fail filter. 

The input vector presented to the no-fail filter is formed 

by SUMIN as follows: 

1) each group of like replicated input sensors is broken 
down into 3 classes; available & used by the filter; 
available, but in standby; and failed. SUMIN further 
restricts only a single replication to be active, with 
all others placed either in standby or detected as failed. 

2) rate gyro measurements are compensated for earth and 
platform rates 

31 the input vector, UF1, is formed such that trapezoidal 
integration will be performed by the no-fail filter 
(i.e. U(k) = 0.5*[u(k)+u(k-l)3) 

4) the gravity vector is computed and added to the end of 
UF1 such that UF1 is composed of: 

UF1 = CAx,Ay,Az,P,Q,R,Gx,Gy,Gz] ' 
where (Gx,Gy,Gz) is the gravity vector expressed in the 
G-frame 

51 if any input biases are being estimated, their current 
estimates are subtracted from the NFF input measurements, 
UF1 

call: Call SUMIN 

args: None 

refs: GYROCR, SUMMER, VMPRT 

ref by: INITG. NAV, RECONF 

comm: EKBFO, FILTRT, FLTCTL, GRVTYC, LAOUT, MAIN1, MCONCO, RGOUT, 

RIOUT, SYNC, SYSU1, SYSXBO 


name: SUMOUT 

func: SUMOUT forms a set of average measurements, YF1; to be used 

by the no-fail filter. It functions as follows: 

1) each group of like replicated sensors is classified into 
two sets; available and to be used by the filter; and 
unavailable, failed, or selected out 
21 each element of YF1 is averaged as: 

YF1(*) = (l/nr)*[m(l)+m(2)+. .m(nr)J 
where nr is the number of available, replicated 
measurement sensors, and m is an arbitrary measurement 
31 psi measurements are compensated for any runway yaw by: 


34 



FINDS Programmer's Manual 
Documentation For File: FSFDI.FOR 


YF1(7) = YF1( 7) - PSIRU 

where PSIRU is the runway yaw to north expressed in 
radians 

4) if IYSCL.NE.0 then each measurement is normalized bv the 
expected variance of that siqnal, s.t. 

YFl(i) = YF1( i )*Ysca1e( i ) 
where Xscale is set in subroutine INITF 
call: Call SUMOUT 

args: None 

refs: SUMMER 

refbv: INITG. NAV 

comm: AGOUT. ASOUT, DETXBI, FILTRT, FLTCTL. MLOUT, PSIR, RAOUT, 

RIOUT, SYSYW1, YOBSRV 


name: GYROCR 

func: GYROCR computes the correction terms required to compensate 

the rate gyros for earth and platform rates. GYROCR functions 
as follows: 

I) to ensure that gyro measurements are compensated only 
once per simulation "tick", a local copy of the last 
time (TimesL) is saved. If Times <= TimesL then 
WCOMP(i) = 0.0 for 1*1, ...3 
21 otherwise: 

WCOMP = Trb ' Trl Ml 

where Trb' is the transformation from the runwav to the 
body frame of reference and Trl is the transformation 
from the local level to runwav frame. W1 is the frame 
rates expressed in the local level frame 
Note: most of the variables used in this subroutine are 

computated in GTOI. 
call: Call GYROCR (wcomp) 

args: wcomp - double out vector of compensation terms to be 

subtracted from the rate gyro measurements (see 
description above.) 

refs: MATTV3 

refbv: SUMIN 

comm: ARSTAT, EARTH, PSIR, SIMCOM, TRBER 
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name: GTOI 

func: GTOI forms estimates for inertial position, velocity, and 

acceleration, and runway acceleration. It also computes 
the A/C's current longitude and latitude along with their 
rates of change. In addition. Tic, the last column of Tic, 
coriolis and centripetal correction terms for compensating 
the platform gravity force, and several control variables 
required by the G&C logic are also all computed, 
call: Call GTOI 

args: None 

refs: ASUMER, MATV3, MTH$DATAN2, MTHSDCOS, MTH$DSIN, MTH$DSQRT 

ref by : INITG, NAV 

comm: ARSTAT, EARTH, EGUIDE, EKF1, FILTRT, GRVTYC , IMIS, MAIN1, 

MCONCO, PSIR, RGOUT, SYSU1, TRBER, 


name: CKUNST 

func: CKUNST checks the no-fail filter estimates for divergence 

and sets an abort flag (labort) if a divergence criteria is 
exceeded. The primary benefit of this routine is to reduce 
computation time (and associated costs) by ending a divergent 
run early. The following divergence criteria is used, where 
divergence is declared if: 

1) the altitude estimate is below the runway i.e. XF1(3)<0.0 

2) the absolute sum of the position errors are greater than 
a position error bound. POSBND, i.e. 

sum£ | posit( i )-XFl(i ) | 3>P0SBND for i=l,..3 

3) the absolute sum of the velocity errors exceeds a velocity 
bound, VEL8ND, i.e. 

sumf |VEL0C( i )-XFl(3+i ) | }>VELBND for 1=1, ...3 

4) or the absolute sum of the attitude errors are greater 
than an anqular bound, ANGBND, i.e. 

sumf | a( i )-XFl(6+i ) | }>ANGBND for 1=1,... 3 
where a = [Phi, theta, Psi-Psirul 
If the divergence criteria is met. the stopping time for the 
run. Tstop, is set to the current simulation time, an abort 
flag is set, and messages are sent to the connected terminal 
and the time line file, 
call: Call CKUNST (labort) 

args: labort - integer inout run abort flag, where: 

Iabort=-l 
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indicates run should be aborted, and otherwise run should 
proceed. 

refs: ALTYP, TLOUT 

refbv: NAV 

comm: ANGLES. EKF1, FILTIC, PSIR. SETCOM, SIMCOM, UPDAT 


name: 
func : 


call : 
args: 

ref s : 

refbv: 

comm: 


KALMN 

KALMN serves as the executive routine to implement an extended 
Kalman filter, where the plant equations are: 

X(k+1) = A x(k) + BCX(k) 3u( k ) + ECX(k)Jw(k) 
and the measurement equation is: 
y(k) = htX(k)] + u(k) 

The filter is realized as a lower order bias-free filter 
followed by a bias filter and a blender to form the bias 
corrected state estimates. The reader is referred to [33 and 
C43 for a more detailed description of the approach. KALMN is 
meant to be called in two passes; once to perform all the 
filter propagations, and then again to update the estimates 
and covariance with the measurements. The following user 
supplied routines are required to define the non-linear terms: 
UPOA defines A 
UPOAB defines ABF1 
UPDB defines BCX(k)3 
UPDO defines 0CX(k)3 
UPDH defines hCx(k)3 
UPDPH defines HP1 
Call KALMN (Iupl 

lup - integer in update/propagate flag, where Iup=l 

enables updating, and Iup=2 enables propagation 
BIASF, BLEND. EKFN1 
NAV, RECONF 
SYSXBO 
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name: EKFN1 

func: EKFN1 represents the bias-free filter portion of the no-fail 

filter. It is implemented as an extended Kalman filter. 
Covariance propagation of the stabilized normal equations 
is performed. The state estimates. XF1 are NOT computed in 
this subroutine, rather they are formed in subroutine BLEND. 
To accomodate reconfiguration due to the failure or a healing 
of a sensor, the state and covariance at time k/k is stored 
temporarily in RBFO. Figure 5 details this module. The 
reader is also referred to C33 and C43 for a detailed 
description of the no-fail filter's implementation, 
call: Call EKF1 (Iup) 

args: Iup - integer in update/propagate flag 

refs: EQUATE. GMINV, MA0D1, MADDI, MAT1A, MAT2, MAT3, MAT5, PWUL, 

NMUL2, MSCALE. UPOAB, UPDB, UPDPH, UPDO 
ref by: KALMN 

comm: EKF1. FILTRT, FLTCTL, MAIN2. SYSU1, SYSX1, SYSXBO, 

SYSYBO, SYSYW1, TSTORE 
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name: BIASF 

func: BIASF implements the bias filter portion of the no-fail 

filter. The operation of this routine is shown in Figure 6. 
The reader is referred to [3] and C4] for detailed 
descriptions of the no-fail filter implementation. A 
software switch exists in this routine which can be set at 
compile time or at run time via the Fortran debugger. The 
switch is IGNC: if IGNC=1 use an anti-svmetric equation for 
PBFO, otherwise use a (more complicated) symetric equation, 
call: Call BIASF (Iup) 

args: Iup - integer in update/propaqate flaq 

refs: ALTYP, BLGAIN, DGATIO, EQUATE, GMINV. MADD1. MADDI, MAT1, 

MAT1A, MAT3, MAT3A, MAT4, W1JL, VMPRT 
refbv: KALMN 

comm: CMPSTF. EKBFO, EK.F1, FILTRT, FLTCTL. GBLEND, INOU. MAIN1, 

MAIN2, SYSU1, SYSX1. SYSXBO, SYSYBO. SYSYW1, TSTORE, YOBSRV 
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Figure 6. now Diagram for subroutine biasf (concluded) 
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name: BLEND 

func: BLEND computes the bias and bias-free state estimates and 

"blends" them together to form the total state and bias 
estimates. It also forms the total state and bias estimation 
error covariance and Kalman gain matrix. Figure 7 details the 
operation of BLEND, 
call: Call BLEND (Iup) 

args: Iup - inteqer in update/propagate flaq 

refs: EQUATE, MADDi, MAT1, MAT4, PMUL, TRANS2, UPDH, VECNUL, VMATl, 

VMAT2 
ref by: KALMN 

comm: CMPSTF, DETINF, EKBFO, EKF1, FILTRT, FLTCTL, GBLEND, MAIN2, 

SYSU1, SYSX1, SYSXBO, SYSYBO, SYSYW1, TSTORE 
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Figure 7. now Diagram for Subroutine BLEND (concluded) 
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name: BLGAIN 

func: BLGAIN computes the blender gain. VB. in a recursive fashion. 

VB is computed recursively as: 

VB( i+1 ) = CI-GAINk ,lr HPl]*ABFl*VB( i 1 

+ C-BFlub + GAINk(HPl*BFlub-D)] 
where the second term is computed as the augmented matrix: 
C(GAINP*HPl-I)*BFlub , -Gaink*D] 

BFlub refers to a matrix built out of the columns of BF1. 
where each column, corresponding to biases which are 
estimated. 

is included (augmented together) to form BFlub. 
call: Call BLGAIN (VB) 

args: VB - double inout updated blender gain matrix 

refs: MADD1, MADDI, MAT1, IWJL2, MSCALE 

refbv: BIASF 

comm: EKF1, MAIN1, MAIN2, SYSU1, SYSX1. SYSXBO. SYSYW1, TSTORE. 

YOBSRV 


name: SETISN 

func: SETISN maintains the value of a vector called ICNTSN. The 

ordering of elements in ICNTSN are constant and correspond 
to the absolute replicated sensor ordering found in Table 6. 
The value of each element is the location in UF1 for the 
first six elements, and the location in the expanded inno- 
vations. RF1, for the rest of ICNTSN. 

ICNTSN provides a "mapping' 1 between an absolute indexing 
scheme and a particular (collapsed - due to failures) indexing 
scheme used by the NFF 
call: Call SETISN 

args: None 

refs: IMSCLE 

ref by: RECONF 

comm: DETINF, DETXBI, FILTRT, SYSU1 
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name: CHKRAD 

func: CHKRAD checks radar altimeter turn-on criteria. If the 

following criteria are satisified the radar altimeter 
measurements are added to the no-fail filter measurements, 
and the MLS elevation measurements are removed (selected out). 
RADAR = false (i.e. radar switchover has not occured) 
and |XF1(3)| < Hradar (A/C is below a fixed altitude) 
and Irepls(6)!=0 (vertical accelerometers available) 
Radar altimeter measurements are added by "healing" them, and 
performing the reconf iquration required. In addition, if the 
filter covariance is too small for x and x-dot. it is boosted 
to force the radar altimeter measurements to be used by the 
no-fail filter, 
call: Call CHKRAD 

arqs: None 

refs: RECONF, TLOUT, VECNUL 

ref by: None 

comm: CMPSTF, DCIOEI, DETXBI, EKBFO, EKF1, FILTRT. FLTCTL, HEALCM, 

HFCOM, INOU, L0GIC4, PLOTS, SENSCM, SIMCOM, SYSXBO, SYSYW1 


name: 

func: 


cal 1 : 
args: 


matrix 
ref s : 
ref by : 
comm: 


UPDA 

UPDA updates the discrete state transition matrix (AF1). 
Currently AF1 is a constant so UPDA is called only once, 
is defined in equation (2.2.13) on page 29 of C23 
(where A=AF1). 

Call UPDA (nr,nc,x,A) 


nr - 

integer in 

currently not used 

nc - 

integer in 

currently not used 

x - 

double in 

currently not used 

A - 

double out 

updated discrete state transition 


AF1 


MTH$DEXP 

INITG 

MAIN1, SIGTAU. SYNC 
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name: 

func: 


cal 1 : 
args: 


refs: 
ref by : 
comm: 


name: 

func: 


cal 1 : 
args: 


refs: 
ref bv: 
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UPDAB 

UPDAB updates the discrete state transition matrix (ABF1) to 
include the coupling due to the estimation of input 
measurement biases. It also computes and saves a matrix of 
parti als needed for the bank of detectors BDFI. 
Computationally UPOAB computes: 

11 ABF1 = AF1 + partial of BF1*(UF1) w.r.t. XF1 
21 BDFI = partial of BFl**BFIu, w.r.t. phi, theta, psi where 
XBFIu is a vector of failure estimates for input sensors. 
The reader is referred to pages A-l in [33 for a description 
of the partial derivative terms required for this module. 

Call UPOAB (ns,nu,u,AB) 

ns - integer in currently not used 

nu - integer in currently not used 

u - double in input measurement vectors (UF1) 

AB - double out updated discrete state transition 

matrix 

which includes the coupling due to input measurement 
biases. 

None 

EKFN1 

DETXBI, EULER, MAIN1, SYNC, TRBER 


UPDB 

UPDB updates the discrete input weighting matrix. BF1, and 
also evaluates and saves: 

1) sines and cosines of the estimated euler angles 
21 the transformation from the B to the R frame 
31 the transformation from the R to the E frame 
BF1 is defined in equation (2.2.13) on page 29 of C23 
where (B=BF1) 

Call UPDB (nx,nu,x,B) 


nx - 

integer in 

currently not used 

nu - 

integer in 

currently not used 

x - 

double in 

vector of current state estimates 


(e.g. XF1) 


B - 

double out 

updated discrete input weighting 


matrix 



MTHiDCOS. MTH$DSIN, MTHSDTAN 
EKFN1. INITG 
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comm: 


name: 

func: 


call : 
args: 


refs: 
ref by : 
comm: 


EULER, FLTCTL, MINI, SYNC, TRBER 


UPDO 


UPDO updates the discrete process noise covariance matrix, 
0F1. UPDO assumes that UPDB has been called recently, 
therefore Trb and Ter are current. 0F1 is defined in 
equation (2.2.14) on page 30 of C2J (where Q=QF1). In 
addition, provisions have been made in UPDO to allow for 
the following modifications to QF1: 

1) modeling errors, not accounted for by the plant and 
measurement equations, can be accounted for partially 
by increasing the process noise variance. Therefore, a 
vector of terms, called DIAGQ is added to the diagonal of 
0F1. Currently DIAGO is set to zero and can only be 
changed at compile time or via the debugger at run time. 

2) to represent errors due to scale factor and misalignment 
of the rate gyros, the following terms are added to the 
measurement noise variance for rate gyros: 


/ \ 

10 1 1 | 

Vrg = V + spm* | 1 0 1 | 
II 1 0| 
\ / 


/ \ i \ 
| STMP1 | | STMP1 | 
| STMP2 | + scaleF* |STMP2| 

| STMP3 | I STMP3 | 
\ i \ / 


where each of these terms are defined in comments in the 
actual code. 

Call UPDO (nx,ndistb,V,0) 


nx - 
ndi stb- 
V - 

0 - 


integer 
1 nteger 
double 
used by 
double 


in 

in 

in 

the 

out 


total number of states 
currently not used 

vector of measurement noise variance 
filter 

updated discrete process noise 


covariance 


LIMVAL. MTHSDEXP 
EKFN1 

ARSTAT, MAIN1, MC0NC0. RGMP, SIGTAU, SYNC. TRBER 
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name: UPDH 

func: UPDH updates the non-linear observations function H. H is 

defined in equations (2.2.151-12.2.24) on pages 30 and 31 in 
[2] (where htx(k)] = H). 
call: Call UPDH (ny,nx,X,H) 

args: ny - integer in currently not used 

nx - integer in currently not used 

X - double in vector of current state estimates 

H - double out updated vector of observations 
refs: MTHSDASIN, MTHSDSQRT 

refbv: BLEM). RCOF 

comm: FILTRT, MAIN1, MLSALL, X0Y0Z0, YOBSRV 


name: UPDPH 

func: UPDPH updates the partial of H w.r.t. XF1. called HP1. 

HP1 is defined on pages A-3 - A-5 in C3J. 
cal 1 : Cal 1 UPDPH f nx,X) 

args: nx - integer in total number of states 

X - double in vector of current state estimates 

refs: MSCALE, MTH$DSQRT 

refbv: CLPSIO, EKFN1 

comm: CMPSTF. MAIN1, MLSALL. SYSU1. SYSXBO, SYSYW1. X0Y0Z0, YOBSRV 


name: DETECT 

func: DETECT implements a bank of detectors and likelihood ratio 

computers. Each detector estimates the level of a bias 
iump failure - hypothesized to start at the beginning of 
an estimation window - by observing the expanded and filtered 
residuals sequence generated bv RESCMP and FILCOL. The 
hypothesized failure is assumed to affect no-fail filter 
input measurements or output measurements only. Therefore, 
a single failure cannot directly enter into BOTH an input 
and an output measurement. 

The bank of likelihood ratio computers operate over a decision 
residual window and are designed to compute the log likelihood 
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of a singleton sensor failure, or a dual simultaneous failure 
in MLS sensors. 

Subroutine DETECT functions as an executive of this bank of 
detector/LR computers. It is responsible for computing all 
common terms required to intialize the parallel bank at the 
time of estimation and decision window resets, managing the 
estimation and decision window mechanisims, and implementing 
the parallel computations in a sequential fashion. The reader 
is referred to C13-C3J for detailed descriptions of the method 
of operation, and particularly to figure 1 on page 12 in C21 
which gives a functional description. Since 
subroutine DETECT is a kev subroutine in the FINOS program. 
Figure 8, a detailed flow diagram, is supplied to describe 
its operation, 
call: Call DETECT 

args: None 

refs: EQUATE. GMINV, LIB*INIT _TIMER. LIB$STAT TIMER. LKF. LRT, 

MADD1, MAT1, MAT6, MATNUL, IWUL, WUL2, MSCALE. VECNUL, VMPRT 
refbv: NAV 

comm: CMPSTF, CNEST, COLFIL, CPU, DCIDEI, OETINF, DETXBI. DETYBI, 

EKBFO, FILTRT, FLTCTL, HEAL CM, INITVL, MAIN1, MAIN2, MULTDT, 
SENSCM. SYSU1, SYSX1, SYSXBO, SYSYW1, TSTORE. YOBSRV 
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Fi^zre 8. Row Diagram for Subroutine DETECT 
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Figure 8. Flow Diagram for Subroutine DETECT (continued) 
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Figure 8. now Diagram for subroutine detect (continued) 
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Figure 8. Row Diagram for Subroutine DETECT (continued) 
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Figure 8. now Diagram for subroutine DETECT (continued) 
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compute the 
effective 
observation 
matrix for 
the detector, 
see page 42 in [X] 


; save the observation matrix 
and failure estimate 
] (used later to detect 
\ multiple I1LS failures) 


Figure 8. Row Diagram for Subroutine DETECT (continued) 
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Figure 8. Flow Diagram for Subroutine DETECT (continued) 
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Figure 8. Flow Diagram for Subroutine DETECT (continued) 
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Figure 8. Flow Diagram for Subroutine DETECT (concluded) 


62 







FINDS Programmer's Manual 
Documentation For File: FSFDI.FOR 


name: LKF 

func: LKF provides the estimator structure for the failure 

detectors. LKF implements a linear Kalman filter using the 
information form, and assumes a scalar state equation. The 
module functions as follows: 

The plant equation is: 

Xmi(k+1) = Xmi ( k ) ; i.e. no dynamics 

the measurement equation is of the form: 

Y(k+1) = Ci*Xmi(k) + n(k+l) ; Y(k+1) is a vector 

of ny elements 
where n(k+l) ~ N(0,RT) 
the filter equations are: 

RTinv = RT**-1 (measurement noise covariance) 

Gi = Cl .O/Pmi ( k ) l*Ci '*RTinv (filter gain) 

Pmi(k+1) = Pmi(k) + Ci'*RTinv*Ci (fiiter information) 
where, remember, Pmi is defined as the inverse of the 
estimation error covariance (i.e. the information matrix) 
Ri(k+1) = Y(k+1) - Ci*Xmi(k) (detector residuals) 
Xmi(k+1) = Xmi(k) + Gi*Ri(k+l) ("best" estimate) 

For a more detailed explanation of the detectors 
implementation see section 2 .4 in [33, and section 2.1.2 
in C2J. 

call: Call LKF ( Xmi , Pmi ,Ci .RTinv. Y.Ri ,nv) 

args: Xmi - double inout scalar estimate of the state (i'th 

failure ievel estimate) 

Pmi - double inout scalar filter information matrix 

(information in i'th failure estimate Xmi) 

Ci - double in effective observations matrix 

(computed in DETECT) 

RTinv - double in inverse of the measurement noise 

covariance matrix (NFF innovations covariance) 

Y - double in observations vector (expanded 

innovations from the no-fail filter) 

Ri - double out innovations sequence from the LKF 

(failure compensated innovations sequence) 
nv - integer in number of elements in the observations 

vector. Y 

refs: None 

ref by: DETECT 

comm: MAIN1 
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name: LRT 

func: LRT computes the log likelihood ratios over a decision window. 

The computations are as follows: 

11 if k=l A=— PH 7 . This initializes the log likelihood ratio. 
A, to -ln(PHj) at the start of a new decision window. 
(Subroutine INITG initially stores PHj as the log of the 
a-priori probability of a sensors failure). 

2) SUMI = RES '*RTinv*RES 

3) A = 0. 5*SUMI + A 

The reader should refer to section 2.7 in [33 or section 2.1.4 
in [23 for a more detailed description of this method, 
call: Call LRT (k.PHj,RES.RTinv.A,ny) 

args: k - integer in decision window simulation step 

counter 

PHi - double in logarithm of the a-priori probability 

that the i'th sensor will fail 

RES - double in failure corrected innovations sequence 

from the j'th failure detector 

RTinv - double in inverse of the innovations covariance 

matrix 

A - double inout computed value of log likelihood ratio 

for the j'th failure hypotheses 
nv - integer in number of observations 

refs: MAT3A 

ref by: DETECT 

comm: MAIN1 


name: DECIDE 

func: DECIDE computes the decision cost which minimizes Bayes Risk, 

and chooses the most likely hypothesis conditioned on this 
cost vector. DECIDE considers singleton sensor failures as 
well as dual simultaneous failures in MLS sensors. DECIDE 
operates as follows: 

1) find the smallest log likelihood ratio for singleton 
failures (stored in A) 

2) find the smallest log likelihood ratio for multiple 
failures (stored in ALAMDj) 

3) pick the smallest of 1) or 2) and determine the 
corresponding sensor type(s) and replication(s) of this 
sensor 
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cal 1 : 
args: 


refs: 
ref by: 
comm: 


41 if the chosen hypothesis is the no-fail condition 
simply return: 

5) otherwise, print out various messages informing the user 
of the decision, and update the failure queue (i.e. NNfail, 
If ai IT. and IfailRl 
Call DECIDE (m, cost, A, Beta) 

m - integer in total number of singleton failures +1 

(representing the no-fail hypothesis) 
cost - double in currently not used 

A - double in vector of log likelihood ratios for 

singelton failures 

Beta - double in currently not used 

CONVRF, MKMN2- TLOUT, VMPRT 

NAV 

DCIDEI. DETINF, DETXBI, FILTRT. HFCOM, INOU, MAIN2, 

MULTDT, NAMES. PLOTS. SETCOM, SIMCOM, SYSU1 


name: 

func: 


cal 1 : 
args: 


refs: 


ref by: 
comm: 


RECONF 

RECONF reconfigures the FTS for proper operation (if possible) 
after failures have been detected and isolated, and after 
sensors heal. Figure 9 shows a functional flow diagram of 
the operation of RECONF. Also, see section 2.6 of C2]. 

Call RECONF ( IHfai 1 .Iabort) 

I Hf ail— integer in Heal/Fail reconfiguration flag where 
IHfai 1=1 for failures, and otherwise for healings 
Iabort- integer out run abort flag where labort=0 

indicates normal operation, and otherwise indicates 
the run should be aborted 

ALTYP. CLPSIO, EQUATE, IMTCG2, KALMAN, MATCG2, MATNUL, MINSET 
MSCALE. MTHJDEXP, MTH$DL0G, NOISR, PNTINV, RCOV, RESCMP, 
SETISN, SUMIN, TLOUT 
CHKRAD, NAV 

DCIDEI . DETINF, DETXBI, EKBFO, EKF1, FILTRT. GBLENO. HEALCM. 
HFCOM. INITVL. SETCOM. SIMCOM. SYSU1, SYSX1. SYSXBO, SYSYBO 
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Figure 9. Flow Diagram for Subroutine RECOM 7 
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Figure 9. Flow Diagram for Subroutine RECONF (continued) 
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Figure 9. Flow Diagram for Subroutine RECONF (continued) 
















Figure 9. Flow Diagram for Subroutine RECONF (continued) 
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Figure 9. Flow Diagram for Subroutine RECONF (concluded) 
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name: CLPSIO 

func: CLPSIO is used to collapse (or expand) the no-fail filter and 

its associated data structures due to a single failure 
(healing) of a sensor. In particular. CLPSIO does the 
fol lowing: 

1) If lclps<0 (i.e. collapse no-fail filter) 

a) if Isns<=NUl (i.e. for input sensors) 

NOTE: currently FINDS doesn't allow input sensors to 
be removed. The logic that is used currently is only 
partially complete. 

* set 0F1( lsns)=0.0 

* reset PF1 and PBFO by calling subroutine RCOV 

* collapse the input mapping vector, INOUP and adjust 
NUIC 

* if NB!=0 and this sensor has a normal operating bias 
being estimated, collapse the bias estimator by 
calling subroutine CLPSBE 

b) if Isns>Nui (i.e. for measurement sensors) 

* set RF1( ICmdY)=0.0 

* reset PF1 and PBFO by calling subroutine RCOV 

* update NY and INOYP 

* update NYF and INORYP 

* collapse the residuals vector, RESBOC 

* update the inverse measurement pointing vector. 
INOYPI 

* if NB!=0 and the no-fail filter is estimating a 
normal operating bias for this sensor - collapse the 
bias portion of the filter by calling subroutine 
CLPSBE 

2) If lclps>=0 (i.e. expand the no-fail filter 

a) for input sensors: 

* reset the process and measurement noise matrices 
0F1 and RF1. by calling subroutine NOISR 

* update NUIC and INOUP 

* if a normal operating bias is to be estimated add it 
via subroutine CLPSBE 

b) for output sensors: 

* call NOISR to set 0F1 and RF1 

* update NY, and INOYP 

* update NYF, and INORYP 

* expand RESBOC 

* update INOYPI 

* If NB!=0 and a normal operating bias Is to be 
estimated - call CLPSBE 
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* correct the partial derivative of h w.r.t. x, HP1 
by calling subroutine UPDPH 
call: Call CLPSIO ( Iclps, Isns, Ireplc) 

args: Iclps - integer in flag used to control the collapse/ 

expansion of the no-fail filter, where Iclps=-1 indicates to 
collapse and Iclps=l indicates to expand it. 

Isns - integer in absolute index of the sensor 

Ireplc- integer in replication of the sensor 

ints: IcmdY - integer absolute measurement sensor index as 

described in Table 1 on page 9 in [13 
IRsns - integer absolute replicated sensor index (see 

Table 6 ) . 

refs: ALTYP, CLPSBE. IMTCG2, MATCG2, NOISR, PNTINV, RCOV, UPDPH 

ref by: RECONF 

comm: DETINF, DETXBI, EKBFO. EKF1, FILTRT, INITVL, SYSU1, SYSX1. 

SYSXBO, SYSYN1 


name: NOISR 

func: NOISR resets the process or measurement noise covariance terms 

in the no-fail filter for a given sensor type. In particular: 

* if Isns <= NU1 (i.e. it corresponds to an input 
measurement to the no-fail filter) and if body 
mounted sensors are used: 

QFl(Isns) = sig(Isns) yc *2 
otherwise if the RSDIMU is used: 

QFl(Isns) = sig(18) yr *2 for l<Isns<3 
or QFl(Isns) = sig(17)*'*2 for 4<Isns<6 

* if Isns > NU1 (i.e. a measurement sensor) 

RFl(Isns) = sig(Isns-NUl)**2/Ireplf (Isns ) 
(remember Ireplf(Isns) is the number of active 
sensors of this type currently used by the no-fail 
filter) 

call: Call NOISR ( Isns, Ireplc ) 

args: Isns - integer in absolute index of sensor 

Ireplc- integer in currently not used 

refs: None 

ref by : CLPSIO, RECONF 

comm: ASOUT, FILTRT, SIGTAU, SYSU1, SYSYW1 
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name: RESCMP 

func: RESCMP computes the expanded residuals sequence from the 

collapsed residual sequence generated by the no-fail filter. 
The results are then stored In RESBOC. This sequence is 
the same as the one which would have been generated had the 
filter been driven by all replications of the measurement 
sensors rather than their average value. See section 2.3.1 
in C21. RESCMP also computes an estimate of the filter 
observations and stores this result in HXKP1. 
call: Call RESCMP 

args: None 

refs: None 

ref by: NAV. RECONF 

comm: AGOUT, ASOUT, CNTROL, DETINF. EKBFO, EKF1, FILTRT, 

MLOUT, PSIR, RAOUT. RIOUT, SYSU1, SYSXBO, YOBSRV 


name: FILCOL 

func: FICOL estimates colored MLS noise states and compensates the 

expanded innovations sequence generated by RESCMP. This is 
done in an effort to "whiten" the innovations sequence, since 
it is known that the MLS sensors have colored rather than 
white noise statistics, 
call: Call FILCOL 

arqs: None 

refs: EOUATE, MTHJDEXP 

refbv: NAV 

comm: CNEST, COLFIL, DETINF, FILTRT. FLTCTL, MAIN1. MLOUT, PJUNCK. 

SENSCM, SYNC, SYSU1 


name: CLPSBE 

func: CLPSBE is responsible for resetting the bias estimator portion 

of the no-fail filter such that a single bias can be added or 
deleted. In particular. CLPSBE: 

1) calls ADJSTBP to determine IBkey and lYkey and to adjust 
the bias pointer vector INOBP, as well as NXB, NUB, NYB, 
NUB1, and NB. 
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2) if IBkey<0 (implying that either the bias exists and we've 
tried to add it, or the bias doesn't exist and we've tried 
to delete it) then CLPSBE fails by printing out this 
message on the terminal: 

CLPSBE: Routine Fails 

3) if kflag=-l (collapse the bias estimator) 

a) the IBkey row and column of the bias filter error 
covariance, PBFO, is deleted 

b) the IBkey column of the bias filter blender gain, VBO, 
is deleted 

c) the IBkey row of the vector of bias estimates, XBFO, 
is deleted 

4) if kflag!=-l (expand the bias estimator) 

a) PBFO is expanded about the IBkey row and column, and 
they are zeroed out 

b) The initial value of the bias fiter error covariance is 
loaded into the appropriate diagonal element s.t. 

PBFO( IBkey, IBkey )=PBFOI ( Ibi as )**2 

c) VBO is expanded about the IBkey column, and it is zeroed 
out 

d) XBFO is expanded about the IBkey row and zeroed out 

call: Call CLPSBE ( kflag,Ibias) 

args: kflag - integer in flag to indicate whether to collapse 

or expand the bias filter. (-1 => delete, +1 => add) 
Ibi as - integer in absolute index of bias type to be 

added or deleted 

ints: IBkey - integer pointer to the location of the bias 

(absolute sensor index) "Ibias" in the reduced 
no-fail filter bias vectors and matrices 
IVkey - integer pointer to the location in the no-fail 

filter measurement vector which corresponds to bias 
"Ibias" 

refs: AOJTBP, ALTYP, M4TCG2 

refby: CLPSIO 

comm: EKBFO, GBLENO, INITVL, SYSU1, SYSX1, SYSXBO, SYSYW1, YOBSRV 
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cal 1 : 
args: 


refs: 

refby: 

comm: 


name: 

func: 


cal 1 : 
args: 
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ADJTBP 

ADJTBP increments or decrements various and 

scalars used by CLPSBE and the bias filter Itself, when adding 

or deleting biases in the estimator. 

Call ADJTBP (Iflag, Index, Irkev,Iykev) 

Iflag - integer in flag indicating addition or deletion 
of a bias, where -1 => delete, and +1 => add 
Index - integer in absolute index to sensor type of 

bias to be added or deleted 
Irkev - integer out to bias in the reduced 

bias set (i.e. the bias vectors used by the filter) 
if the routine succeeds and Irkey=-1 if the routine 
fails 

Iykey - integer out to absolute output 

index which corresponds to the bias referred to by 
Index. If the bias is on an input measurement then 
lykey=0 

ALTYP, IMTCG2, PNTINV 
CLPSBE 

CMPSTF. DETXBI, SYSU1, SYSX1, SYSXBO, SYSYW1 


RCOV 


RCOV resets the no-fail filter's estimation error covariances 
once a failure has been detected and isolated. In particular 
it sets: 


/ \ / 


PO 

0 I 
1 


| PO 

l 

0 

1 

Pb | 


1 

1 .0 


\ / \ 


\ 

0 I 

| + Vi*Vi'*X**2 

Pb | 

/ 


where X**2 = Xmi**2 + 1.0/Pmi 


2) if PBFO > PbfOI then PBFO is set to PbtOI (i.e. the initial 
uncertainty) and XBFO = 0.0. 

This corresponds to the conditional covariance reset method 
discussed in section 2.6 of 121 . Logic still exists in this 
routine which can be used to cause the other two reset methods 
discussed in [23 to be used, however, a re-compilation of the 
code would be required. 

Call RCOV (PO,Pb,XO,Vi,Xmi,Pmi,Icmd) 

PO - double inout bias free filter estimation error 
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refs: 
ref by: 
comm: 


name: 

func: 


call: 

args: 


refs: 
ref by : 
comm: 


Pb - 
XO - 


Vi - 
Xmi - 
Pmi - 


Icmd - 

MATNUL, 

CLPSIO, 

CMPSTF, 

SYSXBO, 


covariance 
double inout 
covariance 
double inout 
estimates 
double in 
double in 
double in 
failure 
integer in 
sensor 


bias filter estimation error 

vector of current state and bias 

blender gain for the i'th detector 
estimate of the i'th failure level 
information matrix for the i'th 

absolute sensor type of the failed 


UPDH, VMPRT 
RECONF 

EKBFO, EKF1, INITVL, INOU, MAINl, SYSU1, SYSX1, 
SYSYW1, YOBSRV 


MINSET 

MINSET determines if the A/C can operate if a particular 
sensor is removed, by knowing the minimal sensor sub-sets 
allowed for stability. Currently MINSET will allow all 
replications of IMUs to be removed, all replications of PLS 
elevation - provided the radar altimeter is available, and 
all replications of the radar altimeter - provided NLS 
elevation is available. Otherwise, if all replications of any 
other sensor are lost MINSET will abort the run. 

Call MINSET (Isns.Ireplc.Iok) 

Isns - integer in absolute sensor index 

Ireplc- integer in replication of the sensor - currently 

not used 

Iok - integer out abort/run flag where if 

Iok = -1 perform a misson abort, otherwise if 
Iok = 1 allow the sensor in question to be removed 
and the run to proceed 

None 

RECONF 

FILTRT, L0GIC4 
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name: HEALR 

func: HEALR manages the operation of the healer detection logic. 

Its primary function is to maintain all sensors selected 
as "failed" by the FDI logic and determine If they have 
healed or recovered. Healer decisions are made ONLY at the 
end of a healer decision window. Special logic is employed in 
order to force the IMUs to heal in a coordinated fashion 
(i.e. for the i'th replication of an IMU to heal; phi, theta, 
and psi must ail be healthy). This logic, while specific to 
the IMUs, forms the framework required to impose arbitrary 
additional constraints on a sensor's healing. A detailed 
explanation of how the healers operate can be found in section 
2.5 in [ 21 . Also helpful in understanding this routine is the 
description of common blocks HEALCM and HFCOM. Figure 10 
provides a detailed flowchart to indicate how the healers are 
rea lized. 

call: Call HEALR 

args: None 

ints: Xsum - double vector of runninq sums - one for each 

active healing process. See subroutine AVECMP for a 
description of how the elements are computed 
IfailP- integer where the row index is 

the healer process number, and the value of each 
element the corresponding failed sensor's 
location in the list of failed sensors 
flfailT and IfailR) 

NfailL- integer length of IfailP. i.e. number of 

healer processes currently running. Both IfailP and 
NfailL are updated at the start of each new healer 
window. 

IMUrep- integer local test vector used for IMU healing 

logic. The row index is the IMU replication number. 

and 

the value is the number of sensors within that IMU 

that 

have healed 

IMUmap- integer local test matrix used for IMU healinq 

logic. The column index is the IMU replication 

number. 

the rows store particular sensors which have healed, 
and the value stored is the corresponding position in 
the list of healed sensors, IhealP. Note this matrix 
allows us to map the locations in IhealP to each 
replication of an IMU 
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ref s : 
ref by : 
comm: 


Iremov- integer local test vector used for IMU looic. 

This arrav stores the locations in IhealP which 
correspond to sensors which passed the healer decision 
criterion but cannot be allowed to heal - due to other 
constraints. Currently, this means only a portion of 
an IMU has healed 

Nremov- integer length of Iremov, i.e. number of 

sensors which must be removed from the list of healed 
sensors, IhealP 
AVECMP, BUBBLE, LRTHLR, TLOUT 
NAV 

HEALCM, HFCOM. SYSU1 
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Figure 10. Flow Diagram for Subroutine HE/NLR (continued) 
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Nrenov=0 


\ counter for sensors which 'heeled" but camot 
l be removed yet due to additional constraints 


(besides those imposed by the healer logic) 


did ALL or NONE of the components of 


| the i*th replication of the D1U “heal"? 


D1Urep(i)=0 


D1Urep(i)=3? 


| store the colunn of DlUrep (which 

Irenov(Nrenov*j)=D1lMap(j.i) ^ f (which correspond to partial Dll) 

j=l ...D1Urep(j) I healings) into a temporary linear 

\ array. Irenov 


Nrenov=Nrenov*D1l)rep(j) 


i > 3? 


Hrenov! 


finihsed? 

| have any sensors been declared 
"healed" but which cannot heal 
due to additional contraints? 


(i.e. only a part of an DID 
has healed) 


remove the sensors from the 
list of sensors to heal and 
wait for ENTIRE D1U to "heal 


BUB8LE(Irenov. Hrenov. -1) 


collapse IhealP 
by removing the 


sensors pointed to 


by Irenov 


sort Irenov 
fron snail 

to large 


II=IfailP(IhealP(i) 

JJ=IfailT(II) 

t*=IfailR(n) 


Hheal=Nheal-Nrenov 


Tl0UT(17.0.JJ.KK.l) 



i > Hheal? 




Figure 10. Flow Diagram for Subroutine HE/M-R (concluded) 
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name: AVECMP 

func: AVECMP supports the operation of HEALR bv computing the 

running sum of (Xwork-Xfail ) over the healer window of 
length kmxhlr. The value of the sum is reset to zero at the 
start of a new healer window. Xwork and Xfail are defined 
as follows: 

* for input measurement sensors: 

Xwork = a measurement from a (assumed) correctly 
working replicated sensor of the same type 
as the failed one 

Xfail = a measurement from the failed sensor 

* for output measurement sensors: 

Xwork = the estimate of the observation obtained 
from the no-fail filter 

Xfail = the measurement from the failed sensor, 
call: Call AVECMP (Xsum.IfailT.IfailR.kreset) 

args: Xsum - double inout the running sum of (Xwork-Xfail ) for 

a particular failed sensor 

IfailT- integer in absolute sensor type of failed sensor 

IfailR- integer in replication of failed sensor 

kreset- integer in reset flag which indicates the start 

of a new healer window if kreset=l 

refs: None 

ref by: HEALR 

comm: AGOUT. ASOUT. EKF1, LAOUT. MLOUT, PSIR, RAOUT, RIOUT, 

RGOUT, SYSU1, YOBSRV 


name: IRTHLR 

func: LRTHLR performs a likelihood ratio test to determine if 

a sensor has healed at the end of a healer window. The 
test is performed as follows: 

1) a maximum likelihood estimate of the normal operational 
bias is computed as: 

Best = Xsum/length 

where Xsum is computed in AVECMP. and length is the number 
of samples in the window. The estimate is limited by: 
if Best > Bthrsh then Best = Bthrsh 

if Best < -Bthrsh then Best = -Bthrsh 

where Bthrsh is the largest expected bias level for this 
sensor type (set in INITG) 
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2) a maximum likelihood estimate for a failure level is 
computed as: 

Fest = Xsum/length 

The failure estimate is then limited by: 

if Fest > 0.0 & Fest < Fthrsh then Fest = Fthrsh 

if Fest < 0.0 & Fest > -Fthrsh then Fest = -Fthrsh 

where Fthrsh is the smallest expected failure level for 
this sensor type (set in INITG) 

3) a decision function is evaluated as: 

xtmp = 2.0*(Fest-Best )*Xsum + length*! Best**2+Fest**2) 

4) the value of the decision function is compared to a 
decision threshold, Dthrsh (set in INITG), and if xtmp is 
less than Dthrsh the sensor is declared "healed" (by 
setting IHF=-1). A detailed description of this method can 
be found in section 2.5 in [23. 

Call: Call LRTHLR ( Xsum, length, Bthrsh. Fthrsh, Dthrsh, IHF) 

arqs: Xsum - double in the sum, over the entire healer 

window, of (Xwork-Xfai 1 ) as computed bv AVECMP 
length- integer in the number of samples included in the 
healer window 

Bthrsh- double in the maximum expected value for a 

normal operating bias level on this sensor 
Fthrsh- double in the minimum expected value for a 

failure in this sensor 

Dthrsh- double in the decision threshold to be used in 

determining whether a sensor has healed 
IHF - integer out a flaq indicating the outcome of the 
LRT. IHF=-1 if the sensor has healed and if IHF=0 it 
has not healed 
refs: DABS, 0FL0AT 

ref by: HEALR 

comm: None 


name: CONVRF 

func: CONVRF determines the proper conversion factor needed to 

convert from "program" engineering units to "user" or output 
units. It also supplies a 5 character literal name describing 
the name of the units. Currently only no-fall filter states 
and sensors are accounted for. The routine operates as 
fol lows: 
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1) the user supplies a flag, Iopt, to indicate whether states 
or sensors are to be considered 

2) the user also supplies an index, n, which indicates in an 
absolute ordering convention found in table 1, page 9 in 
Cl], which element of the state or sensor vector is 
desired. 

3) CONVRF then determines the conversion factor required and 
stores it in the value of the function CONVRF, and the 

name of the units, stored in Lname. 
call: X=C0NVRF (n, Iopt, Lname) 

args: n - integer in absolute index into the state or 

sensor vector 

Iopt - integer in a flag indicating n is an index into 

the no-fail filter state vector if Iopt=l; or n is a 
sensor type index if Iopt !=1 

Lname - char out a 5 character name for the units to be 
converted to. 

CONVRF- double out the value of the conversion factor 
required to convert to user units. 

refs: None 

ref by : DECIDE, INITG, PRNTIC, TLOUT 

comm: MCONCO 


name: AVBIAS 

func: AVBIAS computes, for a particular sensor type, the effective 

average bias seen by the no-fail filter. AVBIAS operates 
as follows: 

1) for input sensors it subtracts the true signal and noise 
from each measurement and then, if the no-fail filter 
uses more than one replication, averages these quantities 
across replications. The true signal and noise are saved 
in the appropriate sensor modules in EFBSLA and EFBSRG for 
linear accelerometers and rate gyro's respectively. 

2) for output measurement sensors AVBIAS simply averaqes the 
true (i.e. simulated) bias levels across replications. 

call: X=AVBIAS fn) 

args: n - integer in the absolute sensor type index found 

in table 1 on page 9 in C1J 

AVBIAS- double out the effective average bias for the 
n'th sensor type 
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refs: SUMMER 

ref by : PRINTIC. SAVIT 

comm: AGMP, ASMP. EFBS, FILTRT, LAMP. MLSMP, RALMP, RGMP 


3.3.3 Documentation For File; F6AC.F0R - 


3.3.4 Documentation For File: FWINO.FOR - 
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3.3.5 Documentation For File: FSENS.FOR - 


3.3.6 Documentation For File: FIO.FOR - 

name: SAVIT 

func: To save a user selectable set of program variables in a 

periodic fashion on a binary plot file. SAVIT uses a 3 pass 
structure to provide this capability, where: 

Ipass=l provides initialization - SAVIT interactively 
prompts for groups of outputs to be saved 
Ipass=2 save (record) variables 
Ipass=3 flush buffers and close files 
The reader is directed to section 4.4 in C13 for a detailed 
discussion of the plot file contents and interactive prompts 
provided by SAVIT. 
call: Call SAVIT 

args: None 

ints: Ipass - integer in pass flag stored in common block 

FLTCTL 

Lsave - integer vector of yes/no responses to the 

prompting questions (found in Table 6 in C 7 J > - 
used to control execution of the routine, 
refs: ALTYP, AVBIAS. FILER1. ISPEC, IASK, MTH$DSQRT, RECRDS, 

SAVIT. SEQNCE, VECHG1, VECNUL 
refby: FINDS 

comm: ACCLS. AGMP, AGOUT, ANGLES, ARSTAT, ASMP, ASOUT, CMPSTF. 

CNEST. CNTROL, CONTRL, CRTE, DCIDEI. DETINF. DETXBI , DETYBI, 
EGUIDE. EKBFO. EKF1 , FC0M1, FC0M2, FILTRT, FLTCTL, GSLOPE. 
GUIDE, GYROS, IM_S, INITVL. INOU, LAMP, LAOUT, LINAC. L0GIC4, 
MAIN1, MAIN2, MCONCO. MLOUT, MLSALL. MLSMP, PJUNK, PORT, 

PSIR, RALMP. RGMP, RGOUT. R GUIDE. RGYRO, RIOUT, RI0UT2, 

S PC FOR, SYSU1, SYSX1, SYSXBO, SYSYW1, VARLAT, VARLON. UPDAT. 
WIND, YOBSRV 
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name: 

func: 


call: 

args: 


refs: 


ref by: 
comm: 


PRNTIC 


To print FINDS Filter-detector-healer initial conditions, as 
well as sensor module simulated normal operating parameters 
and scheduled failure information. The output is printed to 
a user specified ASCII file in a special table format. The 
output is printed in three passes - corresponding to different 
types of information - controlled by an input flag, IoptnZ. 

The reader is referred to figure 8 starting on page 66 of C 1 3 
for an example of the output generated by PRNTIC. See also 
discussion on IoptnZ below. 

Call PRNTIC ( kdsk,IoptnZl 

kdsk - integer in fortran unit number of the ASCII 
file output will be directed to 
IoptnZ- integer in output control flag where if: 

* IoptnZ = 1: print page 66 of C 1 3 - except for the 

last two lines 


* IoptnZ = 2; print last two lines on page 66 

in Cl] and tables 1, and la 

* IoptnZ = 3; print tables 2-5 on pages 68-69 

in Cl 3 


AHEDR. AVBIAS, CONVRF, FOR$DATE_T_DS, FORtINQUIRE. 
FOR$TIME_T_DS, FSCHED. IDTB, MTHSDEXP, MTHSDSQRT, OUTDAT. 
PAGEFO. PTITL3 
FINDS, NAV 

AGFP. AGMP, ARFDIP. ARFP, ARMP, ASFP, ASMP. DCIDEI, DETSIG. 
DETXBI, EARTH. FILNAM. FILTIC, FILTRT. FLTCTL, FTITL1, GRFDIP. 
GRFP, GRMP, HEALCM, IEST, INITVL. LAFP, LAMP. LINAC2, LNAVl . 
MAIN1, MAIN2, MCONCO, MLSFP. MLSMP. MULTDT, NAMES, PLOTS, 
ORAND. RALFP. RALMP, RGFP, RGMP, RIOUT, RI0UT2, SIGTAU, 

SIGVOR. SIMCOM, SYNC, SYSU1. SYSX1, SYSXBO. WIND. WINDCO 


name: FSCHED 

func: To determine if a particular sensor (addressed by type and 

replication) is scheduled to fail in this simulation run. 

If FSCHED determines that a failure will occur, it determines: 

* the time of failure 

* the failure type (i.e. bias, null, etc.) 

* the simulated failure magnitude 

call: Call FSCHED (IsensT,IsensR,convrt,IfailT,failT,failTY,failm) 

args: IsensT- integer in absolute sensor type (from Table 1 
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in till 

IsensR- integer in replication number of this sensor 
convrt- double in conversion factor to be applied to the 
failure level 

IfailT- integer out failure indication flag where: 

if IfailT = 0 - no filaures are simulated, and if 
IfailT > 0 then IfailT is the failure type with: 

0 = no failures 

1 = increased noise failure 

2 = increased bias failure 

3 = increased scale factor failure 

4 = hardover failure 

5 = null failure 

6 = ramp failure 

failT - double out failure onset time in simulation 
seconds 

failTY- double out failure type (logical) strinq. Ten 
character strinq used to indicate the simulated 
failure mode - if no failures then failTY = ' ' 

failm - double out simulated failure magnitude (in user 
units) 

refs: CHKFL, FLEVEL 

refbv: PRNTIC 

comm: A6FP, AGMP, ASFP, ASMP, LAFP, LAMP, MLSFP, RALFP. RALMP, 

RGFP, RGMP 


name: CHKFL 

func: This routine checks for the occurrence of a failure. It 

assumes that a sensor can only fail once, 
call: Call CHKFL (IpntTF, mxtyp.mxrow, timeF, failT, Ifail ) 

args: IpntTF- integer in row number in timeF to be checked 

(indicates which sensor is to be considered) 
mxtyp - Inteqer in maximum number of sensor failure modes 

simulated (also = col. dimension of timeF) 
mxrow - integer in row dimension of timeF, i.e. matches 

dimension statement's row dimension for timeF 
timeF - double in matrix of failure times. The rows 

correspond to the sensors, and the col. correspond 
to the failure more. Therefore, if sensor i fails 
with a bias failure. timeF(i,2) = the time of failure. 


88 



FINDS Programmer's Manual 
Documentation For File: FIO.FOR 


(second col. represents bias failures, see section 3.3 
in Cl] for more details). If timeF(i.j) >= tstop no 
failures will be simulated. 
failT - double out time of failure determined bv 
subroutine CHKFL 

Ifail - double out failure indicator flag. Ifail = 0 if 
no failure and Ifail = failure type if a failure was 
found. See description on Ifailt in subroutine FSCHEP 
for details. 

ref s : AHEDR 

ref bv: FSCHED 

comm: SETCOM 


name: FLEVEL 

func: To determine the simulated failure level - returned in 

function 

call: X = FLEVEL ( IFtype, index. Fin, Fi b.Fi sf ,Fhard,Framp,convrt) 

args: IFtype- integer in absolute failure type 

(1 <= IFtype <= 6) See FSCHED for details, 
index - integer in index into the failure level vectors 

(sensor indicator). Each failure level vector is 
dimensioned to be the number of sensor types in that 
sensor group. For example, MLS = 3 ( azim.el ,rng) , 
las = 1 

Fin - double in increased noise failure levels 

( vector ) 

Fib - double in increased bias failure levels (vector) 

level s 

Fisf - double in incresed scale factor failure levels 

(vectors) 

Fhard - double in hardover failure levels (vector) 

Framp - double in ramp failure levels (vector) 

convrt- double in conversion factor to be applied to the 

failure level (conversion from proqram to user units) 
Flevel- double out simulated failure level in user units 

refs: ALTYP, CONVRF, MTHSDSORT 

ref by: FSCHED 

comm: ANGLES, AZELRN, CRTE, DETXBI , EGUIDE, EKF1, GSLOPE, 

INOU. L0GIC4, MCONCO, PSIR, SIMCOM, UPDAT, VARLON 
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name: OUTDAT 

func: To print a double precision array in a formatted fashion. 

Specifically OUTOAT performs the following: 

1) prints a one line comment (up to 70 characters) 

2) if convrt! =1.0 each element of the array is 
multiplied by convrt 

3) the array is printed with up to 4 (user specified) 
columns and where each element contains 15 digits. 

call: Call OUTDAT ( kdsk, A, n, convrt, ncol , Letrs ) 

args: kdsk - integer in fortran unit number of the ASCII file 

output will be directed to 
A - double in array to be printed 

n - integer in length of the array, A 

convrt- double in conversion factor to be applied to 

all elements of A before printing 
ncol - integer in desired number of columns (i.e. the 

number of elements per row of printout); 0<ncol<5 
Letrs - char in a one line comment which will be 

printed preceeding output of the array 

refs: AHEDR 

refbv: PRNTIC 

comm: None 


name: TLOUT 

func: To print a coded message (corresponding to an "event") in the 

time line (TLN) file. The reader is referred to section 4.2 
on page 71 of [13 for a detailed description of this file and 
its format. 

call: Call TLOUT (msg,Imsgl,Imsg2,Imsg3,Imsg4) 

args: msg - integer in message number corresponding to the 

event # in table 5 in [13 

Imsgl - integer in first message qualifier - corresponds 
to I.D.#1 in table 5 in [13 

Imsg2 - integer in second message qualifier - corresponds 

to I.D.#2 in table 5 in [13 

Imsg3 - integer in third message qualifier - corresponds 

to I.D.#3 in table 5 in [13 

Imsg4 - integer in fourth message qualifier - corresponds 

to I.D.#4 on pages 71-72, where Imsg4=0 means that 
all floating point information will be recorded in 
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absolute values, and Imsg4=l means they will be 
recorded as estimation errors 
Note: Information for the floatinq point descriptors 

discussed in Section 4.2 in Cll is obtained from the 
common block variables, 
refs: ALTYP. CONVRF, MTH$DSQRT 

ref by : AIRSPS, ATITGS, AUTLO, BLMAS, BMRGS, CHKRAD. CKUNST, DECIDE, 

FINDS, GETMLS, HEALR , LINAC1, NAV, RADALS. RATEG1, RECONF 
comm: ANGLES. AZELRN, CRTE, DETXBI. EGUIDE. EKF1. GSLOPE, INOU. 

L0GIC4, MCONCO, PSIR, SIMCOM, UPDAT, VARLON 
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3.3.7 Documentation For File: FUTSUB.FOR - 


name: 

ABSLIM 



func: 

Limits an input 

variable to lie within a symetric bound 


about zero. 



cal 1 : 

Call ABSLIM (X, 

X 1 im ) 


args: 

X - double 

i nout 

variable to be limited. On return 


- 1 X 1 i m | 

<= X < = 

| XI im ) 


XI im - double 

in 

value of the boundary 

refs: 

None 



refby: 

AUTOLO, BANKTR 



comm: 

None 




name: ACCVEL 

func: Computes velocity and acceleration terms. Usually used 

in G-frame. 

call: Call ACCVEL (RDg,RDDg, hdot, Vg,dtvg, hddot, psita.xtacc) 


args: 

RDg - 

double 

i n 

derivative of position vector C 33 


RDDq - 

double 

in 

2nd derivative of position vector C33 


hdot - 

double 

out 

vertical component of velocity vector 



i .e. hdot = 

— RDg( 3 ) 


Vg - 

double 

out 

magnitude of velocity in x-y plane 


dtvg - 

double 

out 

down track velocity 


hddot - 

double 

out 

vertical component of acceleration 



vector. 

i .e. 

hddot = — RDDgC 3 ) 


psita - 

double 

out 

direction of velocity vector in x-y 



plane 




xtacc - 

double 

out 

cross track acceleration 

refs: 

DATAN2, 

DSQRT 



refby: 

FINDS 




comm: 

None 
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name: 

func: 

cal 1 : 

args: 


refs: 
ref bv: 
comm: 


ROTATV 

Rotates position, velocity, and acceleration vectors in the 
I-frame into the E-frame and G-frames. 

Call ROTATV ( Ri ,RDi ,RDDi , comet, sinet,we,wee,rmag,REi ,RDe, 
RDg,RDDe.RDDg) 


Ri - 

double 

in 

inertial 

position vector in the 



I-frame 

[3] 




ROi - 

double 

i n 

inertial 

velocity vector in the 



I-frame 

C 3 3 




RDDi - 

double 

in 

inertial 

acceleration vector in 

the 


I-frame 

[33 




comet - 

double 

in 

cosine of angle swept by the earth's 


rotation 




sinet - 

double 

in 

sine of 

angle swept bv the earth's 


rotation 




we - 

double 

in 

earth's 

rotation rate 


wee - 

double 

i n 

we * we 



rmag - 

double 

out 

absolute 

value of the length of 

Ri 

REi - 

double 

out 

position 

vector in the E-frame 


RDe - 

double 

out 

earth velocity vector coordinitized in 


the I-frame 




RDg - 

double 

out 

velocity 

vectors in G-frame 


RDDe - 

double 

out 

relative 

accleration between E and I 


frames 





RDDg - 

double 

out 

RDDe transformed to G-frame 



AS IN. DATAN2, MATMUL. ROTMAT 

FINDS 

TRANS 


name: ROTMAT 

func: Computes various frame transformation matrices. Common 

block TRANS provides the inputs to this routine and common 
blocks TRANS and ANGS store the results. In particular if. 

i=l, ANG(l)=phi. ANG(2)=theta and ANG(3)=psi => Tbq 
i=2. ANG(4)=1 atitude, ANG(5)=longitude =) Til.Tel,Tge 
i=3. ANG(3)=latl. ANG(4)=lat2, ANG(5)=lon2-lonl => Tqg 
i=4, ANG(l)=phi, ANG(2)=theta, ANG(3)=psi => Tbi 
call: Call ROTMAT H) 

args: i - inteqer in flaq indicating which transformations 

to compute 
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refs: DCOS, DSIN, MATMUL 

ref by : ACEQIN, AUTLD, FINDS, ROTATV, RUNWAY, WAYPNT 

comm: ANGS, TRANS 


name: RUNGK3 

func: Perform Runge-kutta integration for one simulation step 

ahead 

call: Call RUNGK3 (dtime,Dx,X, DERSUB, n) 

args: dtime - double in simulation step size in seconds 

Dx - double out perturbation in X 

X - double out state vector of length n 

DERSUB- double in subroutine name of the function to 

be integrated, (must be of the form DERSUB (Dx,X,n) ) 
n - integer in length of X and Dx 

refs: DERSUB 

refbv: FINDS 

comm: RUNGEK 


name: RUNWAY 

func: Computes the aircrafts position and velocity vectors in 

the G-frame 

call: Call RUNWAY ( Reor ,Ri ,R0i ,we.cospsi , si npsi ,cwt ,swt, Posit, Veloc ) 

args: Reor - double out runway origin in the I-frame 

Ri - double in inertial position vector in I-frame 

RDi - double in inertial velocity vector in I-frame 

we - double in earths rotation rate 

cospsi- double in cosine of the runway yaw angle 

sinpsi- double in sine of the runway yaw angle 

cwt - double in cosine of we*dtime 

swt - double in sine of we*dtime 

Posit - double out A/C position in the G-frame 

Veloc - double out A/C velocity in the G-frame 

refs: ROTMAT, MATMUL 

refby: FINDS 

comm: TRANS 


94 



FINOS Programmer 's Manual 
Documentation For File: FUTSUB.FOR 


name: 

func: 


call: 

args: 

refs: 
ref by: 
comm: 


name: 

func: 

cal 1 : 
args: 

refs: 
ref by : 
comm: 


name: 

func: 


cal 1 : 
args: 


refs: 
ref by : 
comm: 


SETUM 


Initializes all elements of a vector to a constant 
scalar, i.e. 


X ( i 1 = v ; 
Call SETUM (X,k,V) 

X - double out 

k - Integer in 

V - double in 


for 1 <= i <= k 

vectors to be initialized 

length of vector X 

value to use for initialization 


None 

AUTLD 


None 


VECM 

Multiplies two vectors in an element by element fashion, s.t. 

A(i) = A(i)*B(i) ; for 1 <= i <= n 
Call VECM (A,B,n) 

A - double inout output vector of length n 

B - double in input vector of length n 

n - integer in length of A and B 

None 

BMLAS, BMRGS 
None 


VECMS 

Increments a vector by the element by element product of 
two other vectors, s.t. 

A(i) = A(i) + B(i)*C(i) ; for 1 <= i <= n 

Call VECMS (A,B,C,n ) 

A - double inout output vector of length n 

B - double in input vector of length n 

C - double in input vector of length n 

n - integer in length of A, B, and C 

None 

ATITGS, BMLAS, BMRGS, LINAC1, RATEG1 
None 
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name: VECSUM 

func: Increments a vector by another s.t. 


cal 1 : 

A(i ) = A(i) + 
Call VECSUM (A,B,n) 

args: 

A - 

double inout 


B - 

double in 


n - 

integer in 

refs: 

None 


refby: 

ATITGS, 

BMLAS, BMRGS, 

comm: 

None 



BM ) ; for 1 <= i <= n 

vector to be incremented 
input vector 
length of A and B 

LINAC1, RATE61 


name: 

MATV3 



func: 

Multipl 

y a 3x3 
X = A*Y 

matrix 


Note: 

X and Y 

CANNOT 

cal 1 : 

Call WTV3 ( X ,A 

,Y> 

args: 

X - 

double 

inout 


A - 

double 

in 

refs: 

Y - 
None 

double 

in 

refby: 

comm: 

BMLAS, 

None 

8MRGS, GTOI 


by a vector s.t. 

reside in the same memory locations 

output vector 
input matrix 
input vector 


xDname: MATTV3 

func: Multiply the transpose of a 3x3 matrix by a vector s.t. 


X = A'*Y 



Note: 

X and Y 

CANNOT 

call: 

Call mTTV3 (X. 

,A, Y) 

args: 

X - 

double 

inout 


A - 

double 

in 

refs: 

refby: 

comm: 

Y - 
None 
GYROCR 
None 

double 

i n 


reside in the same memory locations 

output vector 
input matrix 
input vector 
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name: 

func: 


cal 1 : 
args: 


refs: 
ref by: 
comm: 


name: 

func: 

call: 

args: 

refs: 
ref by: 
comm: 


name: 

func: 

call: 

args: 


refs: 
ref by : 
comm: 


MATMUL 

Multiply a 3x3 matrix by a vector (passed as 3 scalar 
elements). Used primarily to multiply the frame 
transformation matrices stored in common block TRANS 
Call MATMUL ( V,a,b,c,d,e.f ) 

V - double in matrix stored with rows packed into 

a 9 element linear array 

a,b,c - double in elements of vector multiplied by V 

d,e,f - double out elements of resultant vector 

None 

ACEOIN, AUTLD. FINDS, ROTATV, ROTMAT. RUNWAY, WAYPNT 
None 


MOVUM 

Equates two vectors, i.e. 

TO = FROM 

Call MOVUM (FR0M,T0,num) 

FROM - double in input array 

TO - double out output array 

num - integer in length of TO and FROM 

None 

AUTLD 

None 


DGATIO 

Prints a matrix out on unit kout with an identifier label 
Call DGATIO (A, nr ,nc, let ) 


A - 
nr - 
nc - 
let - 
None 


double in matrix to be printed 

integer in number of rows in A 

integer in number of columns in A 

integer in 4 character name for the matrix 


BIASF 

INOU. MAIN1 
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name: SUNWER 

func: Computes the averaqe sum of the elements of a vector. 

Elements are included in the average ONLY if a corresponding 
entry in the row of an index matrix is exactly one. 

1 

SUMMER = - SUM £X(i)} : for 1 <= i <= nx, and 

n 

Index(i). Where n is defined as the number of unit entries 
in Index 

call: XX = SUMMER (X,nx, Index) 

args: X - double in vector to be averaged 

nx - integer in length of X and Index 

Index - integer in row vector (of length nx) whose 

elements indicate whether corresponding entries in 
another vector are valid (Index(i)=l) or not 
( Index( i ) !=1) . Note it is implicitly assumed that 
Index is a matrix with row dimension equal to ndim. 
SUMNER- double out value of the average sum of X 

conditioned on the elements of Index 

refs: None 

ref by: AVBIAS, SUMIN, SUMOUT 

comm: MAIN1 


name: ASUMER 

func: Computes the average sum of the elements of a vector. 

Elements are included in the average ONLY if the 
absolute value of a corresponding entry in the row of 
an index matrix is exactly one. 

1 

ASUNMER = - SUM CXf i ) } : for 1 <= i <= nx, and 

n 

| Index( i ) | =1 . Where n is defined as the number of unity 
magnitude entries in Index 
call: XX = ASUMER (X,nx, Index) 

args: X - double in vector to be averaqed 

nx - integer in length of X and Index 

Index - integer in row vector (of length nx) whose 

elements indicate whether corresponding entries in 
another vector are valid ( | Index( i ) |=1 ) or not 
( | Index(i ) | !=1) . Note it is implicitly assumed that 
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Index is a matrix with row dimension equal to ndim. 
ASUMER- double out value of the average sum of X 
conditioned on the elements of Index 

refs: None 

refbv: GTOI 

comm: MAIN1 


name: MAXMIN 

func: Searches a double precision vector and determines the 

maximum and minimum values and their corresponding 
locations . 

call: Call MAXMIN (V, npts, vmax. vmin.nmax.nmin) 


args : 

V - 

double 

i n 

vector to be searched 




npts - 

i nteger 

in 

length of V (i.e. number of elements 



in V to 

be 

searched) 




vmax - 

double 

out 

value of the maximum element in 

V 



vmi n - 

double 

out 

value of the minimum element in 

V 



nmax - 

integer 

out 

location of the maximum element 

i n 

V 


nmin - 

i nteger 

out 

location of the minimum element 

i n 

V 

ref s : 

None 






refbv : 

None 






comm: 

None 







name: MAXMINS 

func: Searches a single precision vector and determines the 

maximum and minimum values and their corresponding 
locations . 

call: Call MAXMINS (V. npts, vmax, vmin.nmax.nmin) 

args: V - real in vector to be searched 

npts - integer in length of V (i.e. number of elements 

in V to be searched) 

vmax - real out value of the maximum element in V 

vmin - real out value of the minimum element in V 

nmax - integer out location of the maximum element in V 

nmin - integer out location of the minimum element in V 

refs: None 
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refbv: None 

comm: None 


name : MXMN2 

func: Searches a double precision vector and determines the 

maximum and minimum values and their corresponding 
locations conditioned on the value of a corresponding 
active/inactive flag in a second Vector. Onlv those 
elements which correspond to "active" elements in the 
conditioning vector are considered in the max-min operation, 
call: Call MXMN2 ( Imactv. V.npts , vmax, vmin.nmax.nmin ) 

args: Imactv- integer in an arrav of active/inactive flags - 

s.t. if an element of Imactv is non-zero then a 
corresponding element in V is active and should be 
considered in the operation. 

V - double in vector to be searched conditioned on 
Imactv 

npts - integer in length of V & Imactv 

vmax - double out value of the maximum element in V 

vmin - double out value of the minimum element in V 

nmax - integer out location of the maximum element in V 

nmin - integer out location of the minimum element in V 

refs: None 

refbv: None 

comm: None 


name: VECHG1 

func: Co collapse or expand the size and ordering of a vector. X. 

as directed bv a pointer vector. KX, and a flag kflag, s.t. 
The pointer vector K.X is simplv an array of 
monotomcallv increasing index pointers into X if kflag=l, 
or Y if Klag=2, which define the proper elements of the 
resulting vector. 

Y = collapsed X if kflag = 1 

Y = expanded X if kflag = 2 l new elements are zeroed) 
One of the k.ev features of this routine is that X and Y 


100 



FINOS Programmer's Manual 
Documentation For File: FUTSUB.FGR 


call: 

args: 


refs: 
ref bv: 
comm: 


name: 
func : 


call: 

arqs: 


ref s : 
ref by : 
comm: 


can be equivalent. 

Call VECH61 ( kf lag, X,KX,Y,n, nmax) 

klaq - integer in flag indicating to collapse if 1 and 
to expand if 2 

X - double in input vector to be collapsed/ 

expanded 

KX - integer in pointer vector used to allocate the 

proper elements to use in the operation 
V - double out output vector which is 

collapsed/expanded version of X 
n - integer in the dimension of KX 

nmax - integer in the dimensioned length of X and V. 

Note: if expanding X. elements of Y are zeroed out 

between n and nmax 

None 

SAVIT 

None 


MAFCG2 

To add or delete a row in a double precision matrix or vector, 
or to add or delete a column in a matrix. If a row or column 
is added, its elements are set to zero. 

Call MATCG2 (,jf lag, index, Y, nr, nc) 

if lag - integer in operation flag where: 

■jflag = 1 add a row : -1 delete a row 
jflag = 2 add a column : -2 delete a column 
index - integer in pointer to row or column to be added 

or deleted 

Y - double inout matrix whose index 'th row or column 
is to be added or deleted 

nr - integer inout number of rows of Y (incremented or 
decremented accordingly in MATCG2) 
nc - integer inout number of columns of Y (incremented or 
decremented accordingly in MATCG2) 

ALTYP 

CLPSBE. CLPSIO. RECONF 
MAIN1 
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name: IMTCG2 

func: To add or delete a row in an integer matrix or vector, 

or to add or delete a column in a matrix. If a row or column 
is added, its elements are set to zero, 
call: Call IMTCG2 ( jf lag, index, IY, nr, nc ) 

args: iflag - integer in operation flag where: 

if lag = 1 add a row ; -1 delete a row 
jflag = 2 add a column : -2 delete a column 
index - integer in pointer to row or column to be added 

or deleted 

IY - integer inout matrix whose "index" row or column 
is to be added or deleted 

nr - integer inout number of rows of Y (incremented or 
decremented accordingly in IMTCG2) 
nc - integer inout number of columns of Y (incremented or 
decremented accordingly in IMTCG2) 

refs: ALTYP 

ref bv: CLPSBE. CLPSIO, RECONF 

comm: MAIN1 


name: PNTINV 

func: Searches a pointer vector for particular entry. The pointer 

vector is an integer array with monotonically increasing 
elements. Typically, a pointer vector will show how a 
(possibly collapsed) vector's elements relate to a standard 
(absolutely indexed) vector. Therefore, this routine can 
be used to answer the following question: "What element of 
the measurement vector (a possibly collapsed vector) 
corresponds to the indicated airspeed's output (an absolute 
index)?" 

call: Call PNTINV ( isns, Ipoint.n, index) 

args: isns - integer in valve searched for in Ipoint (usually 

relates to an absolute index in a standard mappinq) 
Ipoint - integer in pointer vector to be searched 
n - integer in length of Ipoint 

index - inteqer out index in Ipoint where isns was found. 

If isns was not found index < 0 

refs: None 

ref bv : AOJTBP. CLPSIO. RECONF 

comm: None 
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name: LIMVAL 

func: Applies a two sided, symetric limiter about zero to the 

elements of a vector, A. s.t. 

A(i) = AM ) , if | A ( i ) | <= BLimM) 

AM) = sign(A( i ) ) A BLim< i ) , if |AM)| ) BLimM) 
where BLim is a vector of absolute limit stops - one for each 
element in A. 


call : 

Call LIMVAL (A, BLim, n) 



arqs: 

A - 

double inout 

vector 

to be limited 


BLim - 

double in 

vector 

of absolute limit stops 

refs: 

n - 
None 

integer in 

length 

of A and BLim 

refbv: 

comm: 

ATITGS. 

None 

BMLAS, BMRGS. 

LINAC1, RATEG1, UPDO 


name: 

func: 


call: 

args: 


refs: 

refbv: 

comm: 


LIMVL2 

Applies a two sided anti-svmetric limiter to the 
elements of a vector. A. s.t. 

AM ) = BLi m( k. ) ; if A(i) > BLim(k) - upper limit 

At i ) = BLim(k+l) ; if AM) < BLim<k+l) - lower limit 
A( i ) = AM ) : otherwise 

where k = ( i-1 ) *2+1 
Call LIMVL2 (A. BLim. n) 

A - double inout vector to be limited 

BLim - double in vector of upper and lower limits 

(2 for each element of A) 

n - integer in length of A. and half the length of 

BLim 

None 

AIRSPS 

None 
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name: NOISEG 

func: Generates a vector of random samples from a normal 

distribution with zero-mean, and unity variance, 
call: Call NOISEG (X,jseed,n) 

args: X - double out vector of n samples from a N(0,1) 

gaussian distribution 

•jseed - integer inout seed value for the random number 
generator 

n - inteqer in lenqth of X 

refs: GAUSS 

ref by : AfTIGS, BMLAS, BMRGS, LINAC1, RATEG1, STARTF 

comm: None 


name: BARN1 

func: Generates a sinqle random sample from either: 

a N(0,1) distribution if iflag < 0 or, 
a Uniform(-l.l) distribution if iflag > 0. 
call: X = BARN1 (if 1 ag.i key, i seed) 

args: iflag - integer in flag which determines the distribution 

from which to select the sample. If iflag < 0 use an 
N ( 0 , 1 ) distribution, else use a uniform (-1,1) 
distribution 

ikey - integer in not used 

iseed - Integer Inout seed value for the random number 
generator 

BARN1 - double out the value of the sample conditioned on 
if laq 

refs: UNIFRM. GAUSS 

ref by : AIRSPS, ATITGS, BMLAS, BMRGS. GETMLS, ILNAG1. IRATG1, 

NOISEG, RAOALS 
comm: None 
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name: 
func : 


cal 1 : 
arqs: 


refs: 
ref by : 
comm: 


name: 

func: 


cal 1 : 
ars : 


ref s : 
ref bv: 
comm: 


name: 
func : 


cal 1 : 
arqs: 
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GAUSS 

Selects a single random sample from a Nlam.sl distribution. 
Where am = mean, and s = standard deviaiton. Note: this 
routine is specific to the VAX computer. 

Call GAUSS ( i seed, s, am, v/1 


i seed 

- integer inout 
generator 

seed value for the random 

number 

s - 

double in 

standard deviation of the 

distribution 

am - 

double in 

mean value 


v - 

double out 

the sample selected 



RAN. DSORT, DLOG 
BARN1 , WINOGT 
None 


UNIFRM 

Selects a random sample from a uniform distribution 
between 0 and 1. This routine is specific to the VAX 
computer . 

Call UNIFRM (iseed.v) 

iseed - integer inout seed value for the random number 
generator 

v - double out value of the sample obtained from a 
Uniform (0.1) distribution. 

RAN 

BARN1 

None 


NAMFIL 

To create VAX VMS file names which have a common name, and 
various extensions. The common file name is prompted for 
in the first call to NAMFIL - it can be read from the TTY 
or from a data file. 

Call NAMFIL (kunit.Lext.Name) 

kunit - integer in Fortran unit number from which 

respones are to be accepted 

Lext - char in a 4 character file extension of the 
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form ".FOQ" , which is to be appended to the common 
group name 

Name - char out The resulting (12 character max) file 
name created by concatenating a common group name with 
the specific file extension 
refs: ALTYPO, ENCODE 

refby: FINDS 

comm: None 


3.3.8 Documentation For File: FVMSUB.FOR - 


name: 

func: 


call: 

args: 


refs: 
ref bv: 
comm: 


GMINV 


Computes the inverse of a square matrix A. If A is 
singular or if A is NOT square, the routine computes 
the Penrose generalized inverse. See Rust, B., Burrus. 
W.R., and Schneeberger , C.. "A Simple Algorithm for 
Computing the Generalized Inverse of a Matrix". CACM, 


Vol. 9, No. 5, May 1966. 

Call GMINV ( nr,nc,A,V,mr,mt ) 

nr - integer in number of rows in A 

nc - integer in number of columns in A 

A - double in matrix to be inverted 

U - double out generalized inverse of 

mr - integer out rank of A 

mt - integer in used for print control. 


mt=0 


suppresses possible error message printout. 


DOT. D0T2, SWAP, VADD 
BIASF. DETECT. EKFN1 
INOU, MAIN1 
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name: l v MUL 

func: Forms the matrix product 

Z=X Y 

A sparseness test is performed on X. 
call: Call NMUL (X.Y.nl,n2.n3,Z) 


args: 

X - 

double in 

input matrix (nl x n2) 


Y - 

double in 

input matrix (n2 x n3) 


nl - 

integer in 

row dimension of X and Z 


n2 - 

integer in 

col length of X, row length of 


n3 - 

integer in 

col length of Y and Z 

refs: 

Z - 
VADD1 

double out 

output matrix (nl x n3) 

ref bv: 
comm: 

6IASF. 

MAIN1 

BLEND, DETECT, 

EKFN1 


name: NMUL2 

func: Forms the matrix product 

Z=X Y 

A sparseness test is performed on Y. 
call: Call NWJL2 ( X,Y,nl,n2.n3,Z) 

args: X - double in input matrix (nl x n2) 

Y - double in input matrix (n2 x n3) 

nl - integer in row dimension of X and Z 

n2 - integer in col. length of X, row length of Y 

n3 - integer in col. length of Y and Z 

Z - double out output matrix ( nl x n3) 

refs: VADD 

ref bv: BLGAIN. DETECT, EKFN1 

comm: MAIN1 


name: MAT1 

func: Forms the straightforward matrix product 

Z=X Y 

No sparseness tests are performed, 
call: Call MAT1 (X,Y,nl,n2,n3,Z) 

args: X - double in input matrix (nl x n2) 
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Y - 

double in 

input matrix ( n2 x n3) 


nl - 

i nteqer i n 

row dimension of X and Z 


n2 - 

inteqer in 

col. length of X, row length of 


n3 - 

integer in 

col . length of Y and Z 

ref s : 

Z - 
00T3 

double out 

output matrix ( nl x n3) 

ref by : 
comm: 

BIASF, 

MAIN1 

BLENO, BLGAIN, 

DETECT, MAT3, MAT3A 


name: 

MAT1A 


func : 

Forms the matrix product 
Z=X Y 


No sparseness tests 

are performed. Z and Y can start 


at equivalent core 

locations. 

cal 1 : 

Call MAT1A (X.Y.nl, 

n2,n3.Z) 

args: 

X - double in 

input matrix (nl x n2) 


Y - double in 

input matrix (n2 x n31 


nl - integer in 

row dimension of X and Z 


n2 - integer in 

col. lenqth of X, row length of 


n3 - integer in 

col. lenqth of Y and Z 


Z - double out 

output matrix ( nl x n3) 

refs: 

None 


ref bv: 

BIASF. EKFN1 


comm: 

MAIN1 



name: MAT2 

func: Forms the matrix product 

Z=XY ' 

in cases where the product Z is SYf^METRIC. No 
sparseness tests are done. The arravs Z and Y 
can start at equivalent core locations, 
call: Call MAT2 ( nl ,n2.X, Y,Z) 

arqs: nl - inteqer in row dimension of X.Y, and col. 

length of Z. 

n2 - inteqer in col. dimension of X and Y 

X - double in input matrix (nl x n2) 
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Y - 

double in 

input matrix <nl x 

n2 ) 


Z - 

double out 

output matrix ( nl x 

n2 1 

ref s : 

D0T2 




ref bv: 

EK.FN1 




comm: 

MAIN1 





name : 
f unc : 

MAT3 

Forms 

the symmetric 

matrix product 


where 

Z = X Y X ' 

Y is symmetric 

. and no sparseness tests are done. 

call: 

Call 1 

MAI3 (ni.n2.X.Y 

. Z 1 

arqs : 

ni - 

inteaer in 

row length of X and Z. col. 


n2 - 

length of Z. 
i nteaer i n 

col . length of X and Y. row 


x - 

length of Y 
double in 

input matrix (nl x n2i 


Y - 

double in 

input (symmetric) matrix ( n2 x n2 1 


7 - 

double in 

output (symmetric) matrix ini x nl 

refs : 

D0T2. 

MAT 1 


ref bv : 

BIASF 

. EKFN1 


comm: 

MAI Nl 




name : 

Me 1 3A 




rune : 

Forms the symmetric 

matrix product 



Z = x 

Y x 




wnere y is svmm 

etrii 

c . and no soar senes s 

re^rs are dr.ne . 

c a 1 i : 

call MAT3A ini. 

n2. x 

. v . £ i 


aros : 

ni - integer 

i n 

row iengtn .-.r £ 

. col. length of £ 

X 

n.-.' - integer 

i n 

o * . length .,.t 

r. row length or •< 

A - OOUOie 

*s 0 

i n o 1 1 1 matri. in 

£ * nil 


» double 

i n 

input i-vmmetri 

i mat n • > n_; «■ n - , 


- double 

i n 

output i svmmetr 

i c i matrix ini ■ n l 

r^i •?. : 

eie >' i. 




f r* t 0 ' 

hie i f . LF 1 





no 
a no 


i MM 
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comm: MAIN1 


name: MAT4 

func: Forms the matrix product 

Z = XY' 

No sparseness tests are performed. 


call: 

Call 

M4T4 (X, Y,nl,n2, 

n3,Z) 


args : 

X - 

double in 

input matrix (nl 

x n2) 


Y - 

double in 

input matrix (n3 

x n2) 


nl - 

integer in 

row dimension of 

X and Z 


n2 - 

integer in 

col . length of X 

and Y 


n3 - 

i nteger i n 

row length of Y. 

col. length of Z 


Z - 

double out 

output matrix ( nl 

. x n3) 

refs: 

D0T2 




ref bv: 

BIASF 

, BLEND 



comm: 

MAIN1 





name: MAT5 

func: Forms the matrix product 

Z = XY' 

A sparseness test is performed on Y. 
call: Call MAT5 ( X. Y.nl,n2,n3,Z) 

args: X - double in input matrix (nl x n2) 

Y - double in input matrix ( n3 x n2) 

nl - integer in row dimension of X and Z 

n2 - integer in col. length of X and Y 

n3 - integer in row lenqth of Y, col. length of Z 

Z - double out output matrix ( nl x n3) 

refs: VADD, VSCALE 

ref by: EKFN1 

comm: MAIN1 
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name: MAT6 

func: Forms the matrix product 

Z = XY' 

in cases where Z is symmetric. A sparseness test is 
performed on Y. Neither X nor Y mav be equivalent to Z. 
call: Call MAT6 (nl.n2.X,Y,Z) 


args: 

nl - 

integer 

i n 

row length of X.Y, and Z 



n2 - 

integer 

in 

col. lenqth of X. Y, and Z 



X - 

double 

in 

input matrix (nl x n2) 



Y - 

double 

in 

input (symmetric) matrix (nl 

x n2) 


Z - 

double 

out 

output (symmetric) matrix (nl 

x nl ) 

refs: 

VADD 





ref bv: 

DETECT 





comm: 

MAIN1 






name: 

MADDI 


func: 

Adds two matrices as 
Z = X+cl*Y 

follows: 

cal 1 : 

Call MADDI (nr.nc.X.Y 

.Z.cl) 

args: 

nr - integer in 

row length of X.Y. and Z 


nc - integer in 

col. length of X.Y. and Z 


X - double in 

input matrix (nr x nc) 


Y - double in 

input matrix (nr x nc) 


Z - double out 

output matrix (nr x nc) 


el - double in 

scale factor applied to Y 

refs: 

None 


ref bv: 

biasf, blend, blgain. 

DETECT. EK.FN1 

comm: 

MAIN1 



name: MADDI 

func: Sets up square matrix A where: 

A = cl*B+c2*I 
I is an identity matrix, 
call: Call MADDI (n.A.B,cl.c2) 

args: n - integer in size of matrices 

A - double out output matrix (n x n) 
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B - 

double 

in 

input 

matrix 

(n x n ) 



cl - 

double 

in 

scale 

factor 

applied 

to 


c2 - 

double 

in 

scale 

factor 

applied 

to 

refs: 

None 







ref by : 

BIASF, 

BLGAIN, 

DETECT, 

EKFN1 





comm: MAIN1 


name: 

func: 


cal 1 : 
args: 


ref s : 
ref bv: 
comm: 


EQUATE 

Sets a matrix A equal to a matrix B (can be used for 
equating matrix partitions or sub-blocks as well) 

A=B 


Call EQUATE (A.B.nr.nc! 


A - 
B - 
nr - 
nc - 
None 
BIASF, 
MAIN1 


double 
double 
integer 
i nteger 


out 
in 
i n 
i n 


output matrix (nr x nc) 
input matrix (nr x nc) 
row length of A and B 
col . length of A and B 


BLEND, DETECT. EKFN1 , FILCOL, INITG, RECONF 


name: MATNUL 

func: Initializes columns of a matrix to zero. Where: 

Xi = 0, for nl <= i <= n2: 

and Xi is the ith col. of X. In addition, if a flag is 
set. rows between nl and n2 can be nulled out as well, 
call: Call MATNUL ( X,nl,n2,ktrig) 


args: 

X - 

double inout 

matrix to 

be nulled 


nl - 

integer in 

first col . 

(row) to be nulled 


n2 - 

integer in 

last col . 

(row) to be nulled 


ktriq - 

integer in 

flag, when 

ktrig=0 only columns 



are nulled, otherwise rows 

and columns are nulled 

ref s : 

None 




ref by : 

DETECT. 

RCOV, RECONF 



comm: 

MAIN1 
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name: MSCALE 

func: Sets a matrix A equal to a matrix B and scales. 

A = cl*B 

call: Call MSCALE (A.B.nr.nc.cl) 

args: A - double out output matrix (nr x nc) 

B - double in input matrix (nr x nc) 

nr - integer in row length of A and B 

nc - integer in col. length of A and B 

cl - double in scale factor applied to B 

refs: None 

ref by: BLGAIN. DETECT. EKFN1. RECONF. UPDPH 

comm: MAIN1 


name: IRANS2 

func: Transpose a matrix 

AT = A' 

call: Call TRANS2 (nl,n2,A,AT) 

args: nl - integer in row length of A, col. length of AT 

n2 - integer in col. length of A. row length of AT 

A - double in matrix to be transposed nl x n2) 

AT - double out transposed matrix ( n2 x nl) 

refs: None 

refbv: BLEND 

comm: MAIN1 


name: BUBBLE 

func: Performs a bubble sort on an arrav of inteqers. The 

elements of the arrav can be ordered increasinq or 
decreasinq in value, 
call: Call BUBBLE (NA.n.k) 

args: NA - inteqer inout arrav of inteqers to be sorted 

n - inteqer in lenqth of arrav NA 

k - integer in a kev. where k>0 orders NA decreasinq 

in value while k<=0 vields an increasing order 

refs: None 

refbv: HEALR. INITG. READRC 
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comm: None 


name: DOT 

func: Computes the dot for inner) product between two linear 

arravs (column vectors), with accumulation carried out 
in double precision, 
cal 1 : x = 00T ( nr ,A,B) 

args: nr - integer in length of arrays A and B 

A - double in vector 

B - double in vector 

refs: None 

refbv: GMINV, MAT3A 

comm: None 


name: D0T2 

func: Computes the dot (or inner) product between two rows of 

a matrix. 

call: x = D0T2 (nn,A,B) 


args: 

nn - 

integer in 
row length 

length of A(B) 
of A(B) 

times the dimensioned 

refs: 

A - 
B - 
None 

double in 
double in 

row vector (or 
row vector 

row of a matrix) 

refbv: 

GMINV. 

M4T2. M4T3, 

M4T4 


comm: 

MAIN1 

ndim - dimensioned row length 

of A and B 


name: D0T3 

func: Computes the dot (or inner) product between two arravs, 

where one array is stored as a row vector and the other 
as a column vector, 
cal 1 : x = D0T3 (n,A,B) 

args: n - integer in length of A and B 
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A - 

double 

in 

row vector 


B - 

double 

in 

column vetor 

refs: 

None 




refbv: 

MAT1 




comm: 

MAIN1 

ndim - 

dimensioned row length of A 


name: 

func: 

call: 

arqs: 


refs: 
ref bv: 
comm: 


VADD 

To increment a qiven vector A by a second vector s.t.: 
A = A+cl*B 


Call VADD (n.cl.A.B) 


n - 
cl - 
A - 
B - 
None 
6MINV. 
None 


integer in 
double in 
double inout 
double in 


length of A and B 
scale factor 

vector to be incremented 
vector to scale with 


MAT5. MAT6, NMUL2 


name: VADD1 

func: To increment a given row vector A bv a second row vector 

B s.t.: 

Arow = Arow+cl*Brow 

This routine assumes A and B are stored as matrices. 


call: 

Call 

VADD1 (nn. 

cl.A.B) 


args: 

nn - 

i nteqer 

i n 

length of A(B) times the dimensioned 



row length of 

A(B) 


cl - 

double 

in 

scale factor 


A - 

double 

inout 

row vector to be incremented 


B - 

double 

in 

row vector to be scale 

ref s : 

None 




refbv: 

mu 




comm: 

MAIN1 

ndim - 

dimensioned row length of A and B 
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name: 

func: 


call: 

arqs: 


ref s : 
ref bv: 
comm: 


VSCALE 


Equates a vector A to a scaled vector B. A and B can be 
equivalent. 

A = cl*8 


Call VSCALE (A.B.n.cl) 
A - double out 

B - double in 

n - integer in 

cl - integer in 

None 
MAT 5 
None 


vector to store result in 
vector to be scaled 
length of A and B 
scale factor 


name: 

SEONCE 


func: 

Initializes an integer 

array to a monotonical ly 


increasing sequence s. 

t. : 


K = [1.2.3,... 

,n,0,0, ... ,01 ' 

cal 1 : 

Call SEONCE (K,n) 


arqs: 

K - integer out 

array to be initialized 


n - integer in 

length of sequence to be stored in K 

refs: 

None 


ref by : 

INITG. READRC. SAVIT 


comm: 

MAIN1 - ndim - dimensioned lenath of K 


name: INSRTN 

func: Used to update (and maintain) an inteaer vector (of 

pointers) with a new (unique) value. The new value 
is added to the list ONLV if: 

1. it's not already present in the list 

2. the current lenoth of the list is >=0 

3. the current length of the list is < a 
maximum length. 

call: Call INSRTN (Iseq, index, ivalue, mxsize) 

args: Iseq - integer inout array (list) of unique integers 

index - integer inout current length of the list 
ivalue- integer in candidate for addition to the list. 
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Iseq 

mxsize- integer in maximum (dimensioned) length of Iseq 
refs: None 

ref by: READRC 

comm: None 


name: 

VECNULS 



func: 
cal 1 : 

Initializes a linear array to zero - single 
Where : 

X(i) = 0.0 for il <= i <= i2 
Call VECNULS (X,il.i2) 

precision version 

args: 

X - real inout 

vector to be nulled 



i 1 - i nteger i n 

starting element to 

null 

refs: 
ref bv: 
comm: 

i2 - integer in 

None 

None 

None 

final element to null 


name: VECNUL 

func: Initializes a linear array to zero - double precision 

version. Where: 

X(i) = 0.0 for il <= i <= i2 
call: Call VECNULS (X, 11,12) 

args: X - double inout vector to be nulled 

11 - integer in starting element to null 

12 - integer in final element to null 

refs: None 

ref by: BLEND. CHKRAD. DETECT. SAVIT 

comm: None 
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name: SIMP 

func: Interchanges 2 rows. 2 columns, or 2 diagonals of two 

matrices. 

call: Call SWAP (A.B.n.inc) 

arqs: A - double inout a matrix to be interchanged 

B - double inout a matrix to be interchanged 

n - integer in number of elements to be swapped 

inc - integer in interleaving factor, where: inc = 1 

swaps columns, inc = ndim swaps rows, and inc = ndim+1 
swaps diagonals. Where ndim is the row dimension of A 
and B. 

refs: None 

ref by: GMINV 

comm: None 


name: VMATl 

func: Multiplies a given vector bv a matrix. 

Y = A X 

where: X is an n2 vector and A is an nl bv n2 matrix, 
call: Call VMATl (A,X,nl,n2,Y) 

arqs: A - double in input matrix (nl x n2) 

X - double in input vector (n2) 

nl - integer in row of A and length of Y 

n2 - integer In col . of A and X 

Y - double out output vector (nil 

refs: None 

refbv: BLENO 

comm: MAIN1 ndim - dimensioned row length of A 


name: VMAT2 

func: Computes the vector-matrix product sum 

Y = Z+A X 

where is an n2 vector, and A is an nl bv n2 matrix. Y 
and Z can be equivalent, 
call: Call VMAT2 (Z,A,X,nl.n2,Y) 

args: Z - double inout input vector (nl) 
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A - 

double 

in 

input matrix (nl x n2) 


X - 

double 

in 

input vector (n2) 


nl - 

i nteger 
Y and Z 

in 

row length of A, col. lenqth of 


n2 - 

integer 

in 

col . length of A and X 

ref s: 
ref by : 

Y - 

None 

BLEND 

double 

out 

output vector (nl) 

comm: 

MAIN1 

ndim - 

dimensioned row length of A 


3.3.9 Documentation For File: PLOTD.FOR - 

name: PLOTD 

func: Utility proaram to plot the unformatted (binary) time history 

data stored in the .PLT file qenerated bv FINDS, 
call: To invoke PLOTD, the user simply types (at the VMS monitor 

level ) : 

$ RUN PLOTD /NODEBUG 

or. if FOREIGN.COM has been executed : 

$ PLOTD 

PLOTD will then prompt the user for various directive 
commands. Time history data is identified by a unique name 
stored in the header of the .PLT file. (See Table 6 on 
page 82 of Cl] for a current list of these names.) 
outs: PLOTD can be used to generate plots of one or several 

variables versus time, or to create cross plots of one 
variable vrs. another. Currently PLOTD creates a single plot 
per paqe. The plots can be qenerated on a TEKTRONIX 
4010/4014 or anv terminal capable of emulating a 4010 or 4014. 
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3.3.10 Documentation For File: PRINTD.FOR - 

name: PR INTO 

func: Utility program used to examine the unformatted (binary) time 

history data stored in the .PLT file generated bv FINDS. 
PRINTD can be used to either display selected data in tabular 
form, or to compute temporal means and autocorrelations. The 
results are presented to the users terminal, the svstem line 
printer, or to a user specified data file, 
call: To invoke PRINTD. the user simplv tvpes (at the VMS monitor 

level ) : 

$ RUN PRINTD /NODEBUG 
or. if FOREIGN.COM has been executed : 

$ PRINTD 

PRINTD will then prompt the user for various directive 
commands. Time history data is identified bv a unique name 
stored in the header of the .PLT file. (See Table 6 on 
page 82 of Cl] for a current list of these names.) 
outs: either; 

a. A table of selected data, where each column of data is 
headed by the name and engineering units. Data can be 
"windowed" by selectinq upper and lower temporal limits. 
Within a window, one can further seqment the data by 
specification of a constant skip factor. 

b. All of the following: 

1. The sample mean. 

2. The sample variance. 

3. The sample autocorrelation function normalized bv the 
sample variance. 

4. The decision of a whiteness test performed on the 
selected data. 

Please see Appendix A.l of Cl] for a more complete 
description. 
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3.3.11 Documentation For File: DOC. RAT - 

name: DOC 

(Ratfor and Fortran Documentation generator) 
func: Prepares a RUNOFF input file from specially formatted embedded 

documentation contained in a RATFOR or FORTRAN program or 
group of programs. Each source file is entered in the table 
of contents and each source file, subroutine, and common block 
is entered in the index. 

The program is executed bv tvping: 

$ DOC 

The user is prompted for the following items: 

Output file name The name to use for the RUNOFF input 

file 

Header level A header at this level is created for 

each separate source file, containina 
the source file name. 

Line lenqth Line lenqth to specifv to RUNOFF 

Input file Name of source file to be processed. 

or name of indirect file. 

No default extensions are assumed for anv of the above. 

In place of specifvinq a source file as input, the user mav 
specifv an indirect file by enterinq "@indirect_file_name" 
when prompted for an input file. The indirect file should 
contain a list of the source files to be processed. This 
option is useful when processing complicated programs spread 
over manv source files. 

Installation notes: 

Simplv compile and link DOC, then execute this command: 

DOC :== Run/nodebuq DOC 
Source program formating notes: 

A documentation header must beqin with the characters "#£doc", 
or "Cdoc" starting in the first column on a separate line, and 
end with the characters "} (without the space), or 
"Cenddoc" also on a seperate line for RATFOR, and FORTRAN 
sources respectively. All the enclosed text will be included 
in the runoff file with the following exceptions: 


121 



FINDS Programmer's Manual 
Documentation For File: DOC. RAT 


* The comment character "C" is stripped off the first column 
of each line in FORTRAN sources. 

* Lines of the form "FIG: FFPF(n)" will be used to set aside 

pages for "Floating Full Page Figures". The number 1< n <99 
is the number of pages required for the figure. 

Anv data in a line beginning "name:" will be assumed to be the 
name of a subroutine or common block and hence will be entered 
in the index. 
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4 INTERNAL DATA STRUCTURES 

This section describes the important common blocks used bv FINDS 
routines to communicate with each other. The first section reviews 
some of the important assumptions and concepts used in buildinq and 
manipulating the internal data structures. The last section describes 
each common block in detail. Each such description contains a 
statement about the contents of the common block and a description of 
each variable in the form: 

name tvpe units description 

These are followed bv a list of all the routines which use the common 
block . 


4.1 Data Structure Conventions 

In the course of developing FINDS, various indexinq schemes were 
required, as well as many special purpose data storage conventions. 
Manv of these conventions become apparent when the detailed flow 
diagrams are studied carefully. The individual realizations of these 
methods are described in the next subsections. This subsection 
attempts to describe the conventions and concepts themselves. 

The oeneral storaae format used for matrices is to allocate 
(dimension) them "ndim" bv "ndim". where "ndim" is an integer variable 
stored in common block /MAIN1/ (ndim=15 in this version of FINDS). 
The i i element of the matrix is then stored in the i i element of the 
storaoe area. Therefore, if the matrix to be stored were of size 5 bv 
5, and ndim = 15. then we view the matrix as a linear array, with a 
column offset of 15 elements (i.e. five data locations followed bv 
ten unused elements in each of 5 columns). Althouqh this storaoe 
scheme is less efficient (from a memorv access point of view) than 
simply storing the columns contiguouslv (with a column offset of 
five), it was necessary in order to use manv of the utilitv routines 
documented in file FUTIL.FOR. 
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The oriains of most of the internal data storaqe conventions can be 
grouped into the following areas: 

. No-fail filter 
. FDI logic 
. Reconfiguration 

The first two areas require internal data structures that maintain an 
absolute index - so the program can relate states, measurements, 
inputs, failures, etc., to particular "physical" sensors or 
quantities. The last area, however, imposes a need to modify the 
absolute ordering to reflect loss or addition of a sensor. Tables 1-7 
define the important absolute indexing schemes employed bv FINDS. 
These tables not only define conventions for particular arrays, but 
also implicitly define all the matrices which operate on them. 

As mentioned above, in order for FINDS to be capable of reconfiguring 
itself the absolute indexing schemes had to be modified. This was 
accomplished by using two techniques. They are: 

. use pointer arrays to provide the mapping between the absolute 
indexing scheme factual locations of the data) and the current 
collapsed/expanded sets. 

. physically collapse or expand the arrays 

Both methods are used in FINDS. The following is a typical example of 
the first method: 

YF1 is a fixed length vector of averaged measurements 
presented to the no-fail filter. It uses the absolute 
measurement indexing convention discussed in Table 2. 

If ALL replications of a particular type of sensor have 
failed, and are therefore not available to the NFF, the 
correspondi ng element in YF1 is zeroed out. A pointer 
array INOYP is used to provide the mapping between the 
(possibly) collapsed measurement vector required by the 
NFF and the fixed length vector YF1 which is maintained. 

Figure 11 graphically shows how this arrangement works. The 
important point to see here is that the data is phvsicallv 
stored in the array using the absolute indexinq scheme, 
and it is extracted using the pointer arrav INOYP which 
accounts for any reconf iguration. 
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An example of the second method is as follows: 

RESBOC is a variable lenqth vector of expanded residuals 
from the NFF. The vector is formed bv first computina the 
residuals usinq the (absolute) replicated measurement 
indexinq convention (see Table 7). and then collapsinq 
it to eliminate elements correspondi nq to sensors which 
are not available. The pointer arrav. INORYP is used to 
mao each element to the absolute index in Table 7. 

Fiqure 12 shows how this approach works. Notice that 
here the data is stored in a collapsed fashion and 
INORYP is used to identify each element (the value of 
an element in INORYP is the measurement index in Table 7) 

The followino arravs use this method of orqanization: 


HP1. RESBOG. RESBOC. RBFO. and CBFO 



Table L No-Fall Filter Absolute State Indexing Conventions 


Array 

Index 

state 

Variable 

Program 

Units 

1 

Xrw 

feet 

2 

Yrw 

feet 

3 

Zrv 

feet 

4 

Xrw 

feet/sec 

5 

Yrw 

feet/sec 

6 

Zrw 

feet/ sec 

7 

Phi 

radians 

8 

Tfteta 

radians 

9 

Psi 

radians 

10 

Xw 

feet/sec 

11 

Y» 

feet/sec 
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Table 2. No-Fail Filter Absolute Measurement Indexing Conventions 


Array 

Index 

Measurement 

Name 

Program 

Units 

1 

Azm 

radians 

2 

El 

radians 

3 

Rng 

feet 

4 

IAS 

feet/sec 

5 

Phi 

radians 

6 

Theta 

radians 

7 

Psi 

radians 

8 

RA 

feet 
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Table 3. No-Fail Filter Absolute Input Indexing Conventions 


Array 

Index 

Input 

Name 

Program 

Units 

1 

Ax 

feet/sec/sec 

2 

Ay 

feet/sec/ sec 

3 

Az 

feet/sec/ sec 

4 

P 

radians/sec 

5 

Q 

radians/sec 

6 

R 

radians/sec 
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Table 4. No-Fail Filter Process Noise Indexing Conventions 


Array Program 


Index 

Name 

Units 

1 

Ax 

feet/sec/sec 

2 

Ay 

feet/sec/sec 

3 

Az 

feet/sec/sec 

4 

P 

radlans/sec 

5 

0 

radians/sec 

6 

R 

radians/sec 

7 

Xv 

feet/sec 

8 

Yw 

feet/sec 


129 




Table 5. Absolute Sensor Indexing Conventions 


Array 

Index 

Sensor 

Type 

Program 

Units 

1 

Ax 

feet/sec/sec 

2 

Ay 

feet/sec/sec 

3 

Az 

feet/sec/sec 

4 

P 

radians/sec 

5 

0 

radians/sec 

6 

R 

radians/sec 

7 

Azm 

radians 

8 

El 

radians 

9 

Rng 

feet 

10 

IAS 

feet/sec 

11 

Phi 

radians 

12 

Theta 

radians 

13 

PSl 

radians 

14 

RA 

feet 
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Table 6. Replicated Sensor Indexing Convention 


Array Sensor Program 

Index Ty pe/Reollcatlon Units 


1 

AX-* 

feet/ sec/sec 

2 

Ay-* 

feet/ sec/sec 

3 

AZ-* 

feet/sec/sec 

4 

P-* 

radians/sec 

5 

Q-* 

radians/ sec 

6 

R-* 

radians/sec 

7 

Azm-1 

radians 

8 

El-1 

radians 

9 

Rng-i 

feet 

10 

IAS-l 

feet/sec 

11 

Phi-l 

radians 

12 

Theta-l 

radians 

13 

Psi-1 

radians 

14 

RA-1 

feet 

15 

Azm-2 

radians 

16 

El-2 

radians 

17 

Rng-2 

feet 

18 

IAS-2 

feet/ sec 

19 

Phi-2 

radians 

20 

Theta-2 

radians 

21 

Psi-2 

radians 

22 

RA-2 

feet 


* - refers to the replication currently In use by the NFF 
(ag. 1, 2 , , or 3) 
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Table 7. Replicated Measurement Indexing Convention 


Array 

Index 

Measurement Sensor 
Type/Replication 

Program 

Units 

1 

Azm-1 

radians 

2 

El-l 

radians 

3 

Rng-1 

feet 

4 

IAS-1 

feet/sec 

5 

Phi-1 

radians 

6 

Theta-1 

radians 

7 

Psi-i 

radians 

8 

RA-l 

feet 

9 

Azm-2 

radians 

10 

El-2 

radians 

11 

Rng-2 

feet 

12 

IAS-2 

feet/sec 

13 

Phl-2 

radians 

14 

Theta-2 

radians 

15 

Psi-2 

radians 

16 

RA-2 

feet 
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INOYP 


YF1 



Figure il Example of Pointer Array indexing 


RES80C 


INORYP 





Azm-i 

W 

1 

El-l 


2 

IAS-1 


a 

Phi-1 

w 

5 

Theta- 1 

w 

6 

Psl-1 

- - - 

7 

El-2 


9 

Rng-2 

W' 

10 

w 


0 


0 

0 


□ 

- 


0 

• 



nymax 


nyf 

I 


Figure 12. Example of Collapsed Array Indexing 
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Detailed Descriptions Of FINOS Common Blocks 


4.2 


4.2.1 

name: 

cont: 

vars : 


ref bv 


4.2.2 

name: 

cont: 

vars: 


Detailed Descriptions Of FINDS Common Blocks 


Description Of CMPSTF - 

CMPSTF 

Quantities associated with the composite (bias-free plus bias) 

no-fail filter. 

nxb - integer unitless the total number of states and 

bias states in the NFF 

GAINKX- double mixed the combined no-fail filter 

gain matrix 

PXF1 - double mixed the combined no-fail filter 

estimation error covariance, (see 2.2.32-2.2.35 
in 123) 

: ADJTBP. BIASF, BLEND. CHKRAD, DETECT, INITG, NAV, RCOV. 

SAVIT. STARTF. UPDPH 


Description Of DCIDEI - 
DCIDEI 

Quantities needed bv the LR computations and the decision 
logic . 

Ihvp - integer unitless the hypothesis chosen by the 

decision logic. Where Ihvp = the replicated sensor 
index of the failed sensor if Ihvp<NFTl. or if Ihvp = 
NFT1 it signifies nothing has failed, whereas if 
NFT1< Ihyp<NFTl+3 then it signifies a multiple failure 
of MLS azimuth, elevation, or range respectively 
kCTdwh- integer unitless counter for elapsed samples 

since last decision window was started 
kMXdwh- integer unitless maximum number of samples in a 

decision window (i.e. number of samples/decision 
window) 

kCTewh- integer unitless vector of decision window 

counters - one for each detector. The elements 
are arranged bv absolute replicated sensor index 
kMXewh- integer unitless vector of maximum decision 
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ref bv: 


4.2.3 

name: 

cont: 

vars: 


FINDS Programmer's Manual 
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windows in an estimation window (i.e. number of 
decision windows/estimation windows) - one for each 
detector 

PRIORI- double unitless vector of the log of the prior 

probabilities of failure - one for each sensor, 
ordered bv replicated sensor index 
ALamda- double unitless vector of the log-likelihood 

of a sensor failing - one for each sensor, ordered 
by replicated sensor index 
Betal - double unitless not used currently 

COSTI - double unitless not used currently 

CHKRAD. DECIDE. DETECT, INITG, NAV. PRNTIC, RECONF, SAVIT 


Description Of DETINF - 
DETINF 

Information pertinent to the detectors 

nft - integer unitless the total number of replicated 

sensors (considered for FDI) 
nftl - integer unitless nft+1 

nyf - integer unitless the current number of 

replicated measurement sensors 
INORYP- integer unitless pointer vector to the 

measurement sensor type (from Table 1 in 111). The 
array index is the replicated (and possibly collapsed) 
set of sensors used bv the NFF, and the value of an 
element of INORYP is the absolute sensor type of that 
sensor 

ICNTSN- integer unitless ICNTSN is used to determine 

1. if a particular sensor type and 
replication is being used by the NFF 

2. and if it is being used - which element of 
the input vector or expanded measurement 
vector it corresponds to 

ICNTSN is organized as follows: the array index 
corresponds to the absolute replicated sensor index, 
the value is either 

1) the index in the input vector 
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(if index<=NUl) 

2) or the index in the expanded measurement 
vector (if index>NUl) 

if the sensor is not used by the NFF the value of its 
element in ICNTSN is zero 

RESBOC- double mixed expanded residual vector from 

the no-fail filter, (see 2. 3. 1-2. 3. 3 in C21) 
ref by : BLEND. CLPSIO, DECIDE, DETECT. FILCOL, INITG, NAV. RECONF. 

RESCMP. SAV IT. SETISN 


4.2.4 Description Of DETSIG - 
name: DETSIG 

cont: Sensor noise statistics assumed bv the detectors, 

vars: PDETCT- double mixed vector containing standard 

deviations of the expected noise (in program units) 
assumed for each sensor type by the detectors. PDETCT 
is ordered bv absolute sensor type 
refbv: INITG. PRNTIC 


4.2.5 Description Of DETXBI - 
name: DETXBI 

cont: Quantities associated with the sensor failure detectors 

vars: NF - integer unitless current number of sensor 

TYPES that are active (i.e. not failed) 

NFmax - integer unitless maximum possible number of 

sensor TYPES that can be considered 
NYmax - integer unitless maximum possible number of 

measurement sensor types that can be considered 
XBFI - double mixed vector of current failure 

level estimates - one for each detector. Detectors 
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are ordered using the absolute indexinq scheme for 
replicated sensors, (see 2.3.18 in C23) 

PBFI - double mixed vector of estimation 

information for each estimated failure. Ordered in 
the same fashion as XBFI. (see 2.3.20 in [231 
VBI - double mixed matrix of blender gain vectors 

where each column of VBI is a blender gain vector. 

The columns are indexed using the same scheme as XBFI. 
(see 2.3.17 in C23) 

BDFI - double mixed matrix of partial derivatives 
evaluated about the current failure estimates. 
Specifically, it is the partial of BF1 w.r.t. failures 
in phi, theta, and psi. The matrix is organized as a 
partitioned matrix with each partition of size NX rows 
by 3 columns. The partitions are ordered (in the 
column direction) as the partial of BF1 w.r.t.. the 
first replication of phi. theta, psi. the second 
replication of phi, theta, psi, and so on. If dual 
redundancy is assumed the entire matrix would be 
nx bv 18. (see 2.3.16 in C23) 

ref bv: ADJTBP. CHKRAD, CLPSIO. DECIDE. DETECT, INITF. INITG. PRNTIC, 

RECONF. SAVIT. SETISN. SUMOUT. TLOUT. UPDAB 


4.2.6 Description Of DETYBI - 
name: DETYBI 

cont: Observation matrices and compensated residual vectors for the 

bank of detectors 

vars: RESBI - double mixed matrix of failure compensated 

residuals vectors where each column of RESBI is a 
residuals vector. The columns are ordered by 
replicated sensor index, (see 2.3.14 in C23) 

CBFI - double mixed matrix of detector observation 

matrices where each column of CBFI is an observations 
vector for a detector. The columns are ordered bv 
replicated sensor index, (see 2.3.15 in C23) 
refbv: DETECT. INITG, SAVIT 
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4.2.7 Description Of EKBFO - 
name: EKBFO 

cont: Bias filter arrays used in the bias fiter portion of the 

no-fail fiter (extended Kalman fiter). (see C43) 
vars: XBFO - double mixed bias filter state vector (i.e. 

vector of current normal operating bias estimates 
RESBO - double mixed residuals vector generated bv 

the bias filter portion of the NFF 
GAINBO- double mixed Kalman gain for the bias 

f i 1 ter 

PBFO - double mixed bias filter estimation 

error covariance (or information) 
ref bv: BIASF. BLEND. CHKRAD. CLPSBE. CLPSIO, DETECT. INITG. NAV. 

ARCOV. RECONF. RESCMP. SAVIT. SUMIN 


4.2.8 

name: 

cont: 


vars: 


Description Of FC0M1 - 
FC0M1 

Communication and common variables between FILER1 and 
RECRDS. All quantities are therefore used in generating 


the binary PLT file, 
ntick - integer unitless 
steps/record step 
itick - integer unitless 

itick=ntick variables 
record 

nchan - integer unitless 
saved minus one 
ichan - integer unitless 
saved 

mxchan- integer unit less 
al lowed 

nbuf - integer unitless 
record buffer 
ibuf - integer unitless 
record 

ifold - integer unitless 
cal 1 


ratio of no. of simulation 

counter variable, when 
are recorded in the logical 

total no. of channels to be 

current channel number beinq 

maximum no. of channels 

(fixed) lenqth of the physical 

current length of the physical 

flag indicating a previous 
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ref bv: 


4.2.9 

name: 

cont: 

vars : 


refbv: 


4.2.10 

name: 

cont: 

vars : 


refbv: 


to RECRDS when ipass=2 or 4 

xbuf - real mixed arrav of lenqth nbuf used to 

store the loqical records 
FILER1. FINDS. INITG. NAV, RECRDS, SAVIT. SET 


Description Of FC0M2 - 
FC0M2 

Storage for the names and units of all variables saved 
in the PLT file 

Lname - char strinq list of unique 5 character 

names for each variable stored in the PLT file. 

Lname is of lenqth mxchan 

Lunit - char strinq list of 5 character names for 

the enqineerinq units associated with each variable 
stored in the PLT file. Lname is of lenqth mxchan 
FILER1. FINDS. RECRDS 


Description Of FILNAM - 
FILNAM 


Stores the (12 
bv FINOS. 

character 1 

names of all 

the disk files 

used 

KKBLNK- 

char 

strinq 

blank name used for testing 

FN0K1 - 

char 

strinq 

name 

of 

PLT file 


FNDK.5 - 

char 

strinq 

name 

of 

qeneral input 

file 

FNDK6 - 

char 

strinq 

name 

of 

OUT file 


FNDK7 - 

char 

string 

name 

of 

filter input 

file 

FNDK8 - 

char 

strinq 

name 

of 

TLN file 


FNDK11- 

char 

string 

name 

of 

SUM file 


FNDK12- 

FILER1. 

char 

FINDS, 

strinq 

PRNTIC 

name 

of 

sensor input 

file 
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4.2.11 Description Of FILTIC - 
name: FILTIC 

cont: Additional initial conditions for the no-fail filter 

vars: SDXIC - double mixed vectors of standard deviations 

which define the statistics of an initial normal 
distribution used to choose the initial no-fail filter 
state estimation error (stored in user units) 

XlCerr- double mixed vector of initial no-fail 

filter state estimation errors (stored in user units) 
SDPIC - double mixed vector of standard deviations 

of the diagonal elements of the no-fail filter state 
estimation error covariance (stored in user units) 
POSbnd- double feet position error bound for the 

no-fail filter's divergence test 
VELbnd- double feet/sec velocity error bound for the 

no-fail filter's divergence test 
ANGbnd- double radians annular error bound for the 

no-fail filter's divergence test 
ref by: CKUNST. INITG, STARTF. PRINTIC 


4.2.12 Description Of FILTRT - 
name: FILTRT 

cont: Flans and pointing vectors used bv the no-fail filter 

vars: lupc - integer unitless (not currently used) rate at 

which NFF covariance is updated 1 = l/(dt*Iupc)3 
ike - intener unitless (not currenty used) rate at 

which NFF is updated [= 1/ ( dt*Iupc*IKC ) J 
dtc - double seconds Iupc*Dtime 

IIMUF - intener unitless flag to indicate if NFF uses 

the IMU measurements (O:don't use, !=0:use) 

IRSDF - integer unitless flan to indicate where the 

input measurements are obtained from. (0:bodv mounted 
accelerometers and rate gvros, !=0:RSDIMU) 

IRSDFY- intener unit! ess flag to indicate if the RSDIMU 

computed attitudes are to be used by the NFF (0:don;t 
use. else if IRSDF!=0 & IIMUF=0 & IRSDFY!=0 : then use 
them) 
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MXRPLF- integer unitless the maximum number of sensor 

replications used in the NFF and in the FINDS FDI 
logic - currently limited to 2. 

IREPLF- integer unitless vector of sensor replications 

used bv the NFF. The array index is bv absolute 
sensor type, and the value is the replication count of 
that sensor used by the NFF 

INOUTF- integer unitless a matrix which indicates the 

status of all the sensors used by the NFF. The row 
index of INOUTF corresponds to the absolute sensor 
tvpe, and the column index is the replication number 
of the sensor. The value of each element shows the 
current status of the sensor where: 

-3: unavailable (selected out by decision 

logic) 

-2: failed 

-1: available - but not used by the filter 

(i.e. standby status) 

0: not available to the NFF 

1: available and used 

refbv: AVBIAS, BIASF. BLEND. CHKRAD. CLPSIO, DECIDE. DETECT. EKFN1 . 

FILCOL. GTOI , INITF, INITG, MINSET. NAV, NOISR. PRNTIC. 

RECONF. RESCMP. SAVIT, SETISN, SUMIN, SUMOUT. UPDH 


4.2.13 Description Of FLTCTL - 
name: FLTCTL 

cont: FINDS program control flags 

vars: Ifilt - integer unitless indicates form of NFF. 

Currently If i 1 t=l . signifying only the standard EKF 
is used (i.e. not the square root form) 

IBfilt- integer unitless indicates tvpe of covariance 

propagation in the bias filter, where 1: propagate 
covariance, and 2: propagate information 
IgainP- integer unitless frequency of Kalman filter 

gain printout (in samples/printout) 

Ipass - integer unitless flag to control output to 

(binary) PLT file where 1: initialize PLT fie. 
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2: write data to file. 3: close PLT file 
Istop - integer unitless not used currently 

Iwoc - integer unitless indicates whether white or 

colored MLS noise corrections should be used in the 
NFF. (Is use colored noise assumptions [default], 

0: use white noise assumptions) 

Ierc - integer unitless specifies whether or not 

corrections for earth's rotation are to be used bv NFF 
(1: use corrections Edefalut]. 0: don't use 
corrections ) 

Ivsc - integer unitless flag to indicate if 

measurements are to be scaled by Yscale. (-1: scale 
[default]. 0: don't scale) 

Hradar- double feet altitude below which the radar 

altimeter is used bv the NFF in place of the MLS 
elevation sensor 

ref bv: BIASF. BLEND. CHKRAD. DETECT. EKFN1. FILCOL. FINDS. INITF. 

INITG. NAV. PRNTIC. SAVIT. SUMIN. SUMOUT. UPDB 


4.2.14 Description Of FTITL1 - 

name: FTITL1 

cont: To store the comment records to be stored in the file header 

of the PLT file 

vars: nline - integer unitless number of 56 character comment 

records 

mxlinl- inteaer unitless maximum number of columns 

in LtlTLl 

LTITL1- integer string comment records are stored in 

the columns of LTITL1. LTITL1 is dimensioned 15 bv 
mxlinl 

ref bv: FILER1. FINOS. INITG. PRNTIC 
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4.2.15 Description Of GBLEND - 
name: GBLEND 

cont: No-fail filter blender qain (see C3 1 and [4]) 

vars: VBQ - double mixed no-tail filter blender qain 

ref by : BIASF. BLEND, CLPSBE. INITG. NAV, RECONF 


4.2.16 Description Of HEALCM - 
name: HEALCM 

cont: Quantities used by the healer logic (see section 2.5 in C2J) 

vars: kCThlr- integer unitless contains a running count of 

the elapsed samples since the start of the current 
healer window 

kMXhlr- integer unitless total number of samples to 

process before a healer window should be reset 
CONFBD- double unit less logarithm of the initial 

confidence bound (1/191 for the healer test 
PhealT- double mixed vector containing standard 

deviations of the expected noise (in program units) 
for each sensor type - to be used exclusively bv the 
healers (this allows flexibility in specifvinq the 
sensor noise statistics appropriate to the healers - 
i.e. different from the detectors, no-fail filter, and 
simulation.) PhealT is ordered bv absolute sensor 
tvpe 

Bthrsh- double mixed vector of largest expected 

normal operating biases for each sensor tvpe (in 
program units). Bthrsh is only used in the healer 
logic and is ordered bv absolute sensor index 
Fthrsh- double mixed vector of smallest expected 

failure levels for each sensor type (in proqram 
units). Fthrsh is only used in the healer logic and 
is ordered bv absolute sensor index 
Othrsh- double mixed vector of a decision 

thresholds to be applied to each healer process. 

This vector is ordered by sensor type. 

Othrsh is defined as: 

Dthrsh(i) = 2.0*C0NFBD*Phea!T(i )**2 
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ref by: CHKRAD, DETECT, HEALR, INITG, PRNTIC, RECONF 


4.2.17 Description Of HFCOM - 
name: HFCOM 

cont: Common quantities used by the healing and failure - 

reconfiguration logic in FINDS. 

vars: Nfail - integer unitless total number of sensors that 

FINDS has determined to be "failed" 

NfailM- integer unitless The maximum number of failures 

that FINDS can process (i.e. dimension of IfailT & 
IfailR) 

NNfail- integer unitless number of new failures, i.e. 

the incremental number of sensors which have iust been 
detected as failed - but have not been removed bv the 
reconf iguration logic 

Nheal - inteqer unitless total number of sensors which 

the healer logic has declared healthy at the end of a 
healer window 

NhealM- inteqer unitless the maximum number of sensors 

which can heal in one instant, (i.e. the dimension 
of IhealP) 

IfailT- integer unitless vector containing the absolute 

sensor type for each failed sensor. Whenever a sensor 
fails its absolute sensor type (from Table 51 is added 
to IfailT. Therefore, this vector is ordered by 
relative time of occurrence of the failure, (failed 
sensor index) 

IfailR- integer unitless vector containing the 

replication number for each failed sensor. It is 
ordered the same as IfailT. Together IfailT(i) and 
IfailR(i) determine the i'th failed sensor's type and 
replication. 

IhealP- integer unitless vector containing a list of 

the failed sensors which have healed. The value of 
an element is the index in IfailT and IfailR of the 
healed sensor. Therefore. IhealP(j) represents the 
i'th healed sensor and it (i.e. the value of 
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IhealP(i)) points to the IhealP(j)'th failed sensor 
in If ai IT and IfailR. 

ref by : CHKRAD. DECIDE, INITG. HEALR. RECONF 


4.2.18 
name: 
cont : 
vars : 


ref by : 


Description Of INITVL - 

INITVL 

Initial values for the no-fail filter 

INOBPS- integer unitless IN0BPS=IN0BP at the start of 

the run 

PBFOI - double mixed initial values for the 

standard deviations of the bias free estimation error 
(in user units). Addressed by absolute state index 
( see Table 1 ) 

PBFIC - double mixed initial values for the 

standard deviation of the detector error information 
(in user units), addressed by absolute sensor index 
( see Table 5) 

CLPSBE. CLPSIO, DETECT, INITG. PRNTIC. RCOV. RECONF, SAVIT 


4.2.19 

name: 

cont: 

vars : 


Description Of INOU - 
IMOIJ 

Contains Fortran unit numbers for I/O to the users terminal 


and to all disk files, 
kin - integer unitless 
kout - inteqer unitless 
kdskl - integer unitless 
file 

kdsk5 - inteqer unitless 

general input file 
kdsk6 - integer unitless 


unit no. for input from TTY 
unit no. for output to FTY 
unit no. for output to PLT 

unit no. for input from 

unit no. for output to OUT 
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refby : 


file 

kdsk7 - integer unitless unit no. for input from filter 

input file 

kdskS - integer unitless unit no. for output to TLN 

file 

kdskll- integer unitless unit no. for output to SUM 

file 


kdskl2- integer unitless unit no. for input from sensor 

input file 

AIRSPS. ATITGS, AUTLD. BANKTR, BIASF, BMLAS, BMRGS, CHKRAD. 
DECIDE. DGATIO, FILER1, FINDS, GETMLS. GMINV, ILNAC1, 

INITF, INITG, IRATG1, NAV, RADALS, RCOV, SAVIT, STABCN, 

TLOUT, VMPRT, WAYPNT 


4.2.20 Description Of MAIN1 - 
name: MAIN1 

cont: Provides common dimensioning information for two dimensional 

arravs and a scratch area for temporary use bv all 
subroutines . 

vars: ndim - integer unitless row dimension for two 

dimensional arravs 

ndiml - integer unitless ndim + 1 

C0M1 - double temporary scratch array dimensioned 

ndim bv ndim 

ref bv: ASUMER, BIASF, BLGAIN. DETECT. DGATIO. D0T2. D0T3. EQUATE. 

FILCOL. GETMLS, GMINV. GTOI, IMSCLE, IMTCG2. INITG, LKF, 

LRT, MADD1. MADOI , MAT1. MAT1A, MAT2, MAT3, MAT3A, MAT4, 
MAT5. MATS. MATCG2, MATNUL. NMJL. mJL2. MSCALE, NAV, 

OUTDAT. PRNTIC, RCOV. SAVIT, SEONCE, STARTF. SUMIN, SUMMER. 
TRANSP. UPDA. UPDAB. UPDB. UPDH. UPDPH, UPDO. VADD1 , VMAT1. 
VMAT2. VMPRT, 
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4.2.21 Description Of MAIN2 - 
name: MAIN2 

cont: Provides a temporary scratch array for use by all routines, 

vars: COM2 - double temporary scratch array dimensioned 

ndim bv ndim 

ref bv: BIASF. BLEND. BLGAIN. OETECT. DECIDE. EKFN1, INITG, NAV, 

PRNTIC. SAVIT 


4.2.22 Description Of MULTDT - 
name: MULTDT 

cont: Quantities used in detecting multiple simultaneous failures 

vars: PRIORJ- double mixed vector of the logarithms of 

the prior probability of more than one MLS sensor of 
the same type to fail in the same instant (common mode 
failure) (ordered MLS azimuth, elevation, range) 
ALamdJ- double mixed vector of the log-likelihood 

of a multiple MLS sensor failure. Ordered the same 
as PRIORJ 

RESBJ - double mixed matrix of multiple MLS failure 

compensated residuals vectors. Columns are ordered 
the same as elements of PRIORJ. 
refbv: DECIDE. DETECT. INITG. PRNTIC 


4.2.23 Description Of SENSCM - 
name: SENSCM 

cont: Quantities used in determining the SIMULATED sensor 

configuration 

vars: IIMUS - integer unitless flaq to indicate if the IMU 

sensor signals are simulated (available to the NFF) 
where 1: IMU exists, and 0: IMU doesn't exist 
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IRSDS - inteqer unitless flaa to indicate if the RSDIMU 

is simulated. Where 1: simulated: and 0: not 
simulated 

MXRPLS- inteqer unitless the larqest maximum number of 

replications of anv sensor that was simulated 
IREPLS- inteqer unitless vector whose elements indicate 

the simulated replications of accelerometers, rate 
gyros, MLS, IAS, and IMU sensor systems, respectively 
IREADS- integer unitless not used currently 

ref by : CHKRAD. OETECT, INITG, FILCOL 


4.2.24 

name: 

cont: 

vars: 


ref bv: 


Description Of SIMCOM - 
SIMCOM 

Provides communication between the simulation and the routines 
used to record the PLT file (RECRDS and FILER1) 


ifq - integer 
thalf - real 
time - real seconds 

delt - real seconds 


not used 
not used 

current simulation time 
simulation inteqration step 


size 

nstep - integer 
tstart- real seconds 

simulation 

tstop - real seconds 


not used 

startinq time of the 
final time (estimated) 


CHKRAD. CKUNST, DECIDE. FILER1. FINDS. GYROCR. INITG. 
NAV. PRNTIC, RECONF, RECRDS, TLOUT 


4.2.25 Description Of SMPRM - 
name: SMPRM 

cont: Saves qeneral simulation quantities associated with the 
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vars: 


ref bv: 


PLT file 


nbuf - integer unitless length of the phvsical record 

used to incrementally store the data in the PLT file 
ntick - integer unitless the ratio of no. of simulation 

steps/record steps 

delt - real seconds the intearation step size used 

by FINDS 

LCODE - inteqer not used 

READRC 


4.2.26 Description Of STITL - 

name: STITL 

cont: Stores the comment records contained in the file header 

of the PLT file 

vars: nline - inteqer unitless number of 56 character 

comment records 

mxline- inteqer unitless maximum number of columns 

in LTITL 

LTITLE- inteoer strinq comment records are stored in 

the columns of LTITLE. LTITLE is dimensioned 15 bv 
mx.l i ne 

refbv: READRC 


4.2.27 

Descr i 

Dtion Of 

SySUI - 






name : 

SYSUI 








cont: 

Ouanti 

ties associated with 

the inputs 

to the 

no- 

-fail f i 

Mt< 

var s : 

NO - 

i nteoer 

un i 1 1 es s 

total 

number 

of 

i nputs 

to 



no-f a i 1 

filter i nc 

ludinq aravi 

Q 

C 

> 

.1 1 s 




NUi - 

i nteoer 

un i t less 

total 

number 

of 

inputs 

to 



no-fa i i 

1 i 1 ter- as S' 

ociated with 

an input 

sensor 

1 -] 
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ref bv: 


4.2.28 

name: 

cont: 

vars: 


ref bv: 


NU1P1 - 
NG - 
NU1C - 
INOUP - 


NU-NG) 


NU1+1 

total number of qravity inputs 
NU1 - currently not used 
pointer vector to absolute 
nput measurements used bv the NFF. Where, the array 
index corresponds to the location in UF1, and the 
value is the absolute input measurement type index 
found in Table 3. Note: since we do not allow the 


nteger unitless 
nteqer unitless 
nteqer unitless 
nteqer unitless 


input vector to collapse this array is not strictly 
required - however, it does provide much of the 
functionality needed to facilitate reconf iquring the 
inputs to the NFF in future releases of FINDS. 

UF1 - double mixed vector of compensated inputs 

used by the no-fail filter (computation in SUMIN) 
ADJTBP, AVECMP, BIASF, BLEND, BLGAIN, CLPSBE, CLPSIO, DECIDE. 
DETECT EKFN1, FILCOL, GTOI, HEALR, INITF. INITG. NAV, NOISR, 
PRNTIC, RCOV, RECONF. RESCMP, SAVIT, SETISN, SUMIN. UPDPH 


Description Of SYSX1 - 
SYSX1 

Bias free filter state dimensions and system matrices 
NX - inteqer unitless total number of states in bias 

free portion of the no-fai filter 
NX1 - inteqer unitless NX+1 

AF1 - double mixed describe state transition 

matrix - set in UPDA. (see 2.2.13 in C21) 

BF1 - double mixed discrete processes noise 

covariance matrix (i.e. EWE'), (see 2.2.13 in C23) 
ADJTBP. BIASF, BLEND, BLGAIN. CLPSBE, CLPSIO. DETECT, EKFN1 , 
INITG, NAV, PRNTIC, RCOV, RECONF. SAVIT, STARTF 


150 



4.2.29 

name: 
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vars: 


ref by: 


4.2.30 

name: 

cont: 

vars: 
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Description Of SYSXBO - 
SYSXBO 

Quantities associated with the bias filter portion of the 
NFF. 

NB - integer unitless the current number of biases 

estimated by the NFF (NB=NUB+NYB) 

NUB - Integer unitless the current number of input 

sensor biases estimated by the NFF 
NUB1 - integer uni tl ess NUB+1 

NYB - Integer uni tl ess the current number of 

measurement biases estimated bv the NFF 
NBMXI - integer unitless the original (total) number 

of biases requested to be estimated bv the NFF 
INOBP - integer unitless pointer vector to the sensor 

tvpe of each bias estimated, where the array index is 
the bias index used bv the filter, and the value of 
each element is the absolute sensor index (from 
Table 5) of the corresponding sensor 
ABF1 - double mixed discrete state transition 

matrix which accounts for the estimation of normal 
operating biases, (see eq. 2.2.30 in C21) 

ADJTBP, BIASF, BLEND. BLGAIN. CHKRAD, CLPSBE, CLPSIO. DETECT 
EKFN1. INITG, KALMN, NAV, PRNTIC. RCOV, RECONF. RESCMP. SAVIT. 
SUMIN. UPDPH 


Description Of SYSYW1 - 
SYSYW1 

Quantities associated with the no-fail filter's observations 
and process noises 

NY - integer unitless total number of possibly 

averaged (or collapsed) measurements presented to the 
no-fail filter 

Ndistb- integer unitless total number of process noise 

inputs to the NFF 

NYMXI - integer unitless initial (maximum) number of 

averaged measurements to the NFF 
INOYP - integer unitless pointer vector to "active" 


151 



FINDS Programmer's Manual 
Description Of SYSYW1 


averaqed outputs used by the NFF where INOYP is formed 
such that the arrav index corresponds one-to-one with 
the elements of the (possibly collapsed) measurements 
of the NFF, and the value of each element corresponds 
to the absolute measurement index in Table 2. 

INOYPI- integer unitless inverse mapping of INOYP. i.e. 

the array index is the absolute measurement index, and 
the value is the corresponding index in the current 
measurement vector to the NFF. If a particular 
measurement tvpe is not used bv the filter its value 
in INOYPI will be zero 

YF1 - double mixed vector of averaged 

measurements used by the NFF - uses absolute 
measurement sensor indexing 

RF1 - double mixed vector of measurement noise 

covariances organized by absolute measurement index 
(Table 2). Each element in RF1 is adjusted to 
reflect the number of sensors averaged 

QF1 - double mixed vector of process noise 

covariances organized by absolute input index 
(Table 3). (see 2.2.14 in C21) 

HP1 - double mixed effective observation matrix 

for NFF (partial of h w.r.t.x) (see 2.2.31 in C21) 
ref bv: ADJTBP, BIASF, BLEND. BLGAIN, CHKRAD. CLPSBE. CLPSIO. DETECT. 

EKFN1, INITF. INITG, NAV. NOISR, RCOV, SVIT. SUMOUT. UPDPH 


4.2.31 Description Of YOBSRV - 
name: YOBSRV 

cont: Contains the scaling arrav for the filter observations 

vars: Yscale- double mixed vector of scale factors used 

to scale each averaqed measurement into the NFF. The 
scaling is performed to ensure that the measurement 
noise variance is uni tv for each sensor 
ref bv: AVECMP, BIASF. BLGAIN. CLPSBE. DETECT. INITF, INITG, RCOV 

RESCMP, SAVIT, SUMOUT, UPDH. UPDPH 
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SLWtARY OF SPECIFIC HARDWARE AND SOFTWARE REQUIREMENTS 


Computer: 
Storage: 
Terminals : 

Hard-copy 
devices : 

Operatina 

System: 

Software: 


Digital Equipment - VAX-780 or 750 
At least one disk drive 

Either a Tektronix model 4010/4014 or one that emulates a 
Tektronix 4010/4014 (for plotting purposes.) 

No specific requirements. All output is directed to 
disk files or to the users terminal. 

VMS Version 3.0 or higher. VMS utilities and 
libraries are required. 

Fortran-77 compiler 


The following files are supplied: 

Command Files: 

FINDS.COM 

FINDSLIB.COM 

GETDOC.COM 

MAKEFPG.COM 


Executable Files: 
DOC. EXE 
FINDS.EXE 
PL0TD.EXE 
PRINTD.EXE 


Fortran Files: 
DOC. FOR 
FGAC.FOR 
F 10. FOR 
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FIOSUB.FOR 

FMAIN.FOR 

FSENS .FOR 

FSFDI .FOR 

FUTSUB.FOR 

FVMSUB.FOR 

FWIND.FOR 

PLOTD.FOR 

PRINTD.FOR 


Libraries: 

FINDSLIB.OLB 

OPT Files: 

PLOT. OPT 
PRINTD.OPT 

COM files: 

FINDSC.COM 
FINDSL.COM 
FINDSLIB.COM 
FOREIGN.COM 
FPMV3.COM 
FIL files: 

FINDSPM.FIL 
FINDSPMA.FIL 
FINDSPMB.FIL 
RNO files: 

FPMV3.RN0 

LISA floppy disk files: 

A 5 1/4 floppy disk which contains two Lisa Draw applications 

1. FINDSfigs - all the flowcharts in the FINOS programmers 
manual . 

2. FINDScharts - all the tables used in the FINDS programmers 
manual . 
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APPENDIX B 

GENERATING THE FINDS PROGRAMMERS MANUAL 


It was stated in the introduction that this manual was generated in a 
semi-automatic fashion using a combination of a rudimentary text 
formatting program called Digital Standard Runoff (DSR), an Apple Lisa 
computer usinq LisaDraw, and a text stripping program (DOC). This 
appendix provides the details of this system. In particular this 

appendix will: 

o Enumerate the procedure required to produce a copv of this 
programmers manual . 

o Briefly describe the mechanics of the automatic documentation 
system. 

o Document the current set of "rules" for embedded source code 
documentation. 

o Describe the steps required for adding future documentation 
to the manual . 

o And finally, present some observed stengths and shortcomings 
of this approach. 


The following steps are required to produce a copy of this manual: 

1. Type $ ©foreign and then $ ©findspg , this produces a file 
fpmv3.mem which can be printed on a suitable printing device 
(daisv wheel, dot matrix, or laser printer). 
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2. Load the Lisa floppy disk into an Apple Lisa computer and 

print all the figures and tables using LisaDraw, or 

alternatively if a file of current figures is maintained, 
simply make copies of the figures and tables. 

3. Insert the figures and tables into the document in the 
approriate places. 


As shown above, only three simple steps are required to produce a copy 
of an existing manual. Now let's take a closer look at what actually 
was performed in step 1. Figure 13 shows a closeup of the underlying 
mechanics. From this figure we can see that step 1 first stripped, 
from a list of files, documentation containing: 

o Each file's contents 

o Subroutine descriptions 

o Common block descriptions 

In addition, index items were added and the files were put in a form 
compatible with DSR (all done via the program DOC.) Each type of 
information is saved in a separate file. These files are then 
referenced in a runoff file which contains a template of the manual 
(e.g. the Introduction, Appendicies, and beginnings of chapters where 
the files will be included.) The output of DSR is a file which 
contains all the written text, and saves "white" space for all the 
figures and tables. 
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Finished 

Manual 


Figure 13. Mechanics of Automatic Manual Generation 
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In order for the text stripping program, DOC, to work properly various 
"rules" are required for placing embedded documentation in Fortran 
source files. The basic premise is that comment lines which occur 
between special header lines are to be treated as documentation. 

Currently the following header delimiters are supported: 

1. Cfil ... Cendfil - These bracket file content comments. 

2. Cdoc ... Cenddoc - These bracket subroutine documentation. 

3. Ccom ... Cendcom - These bracket common block documentation. 

In qeneral, formattinq within header delimiters is arbitrary. 
However, if "Cname:" is encountered, the rest of the line is treated 
as a file, subroutine or common block name and is entered into the 

index. Furthermore, if fiqures are required, DOC can be used to save 

space for them. This is done bv using the following construct: 
"Cfig: FFPF(n)“ where l<n<99 is the number of Floatinq Full Page 

Fiqures required. The following rules must be followed: 

1. Header delimiters must occur on separate lines 

2. Each line between header delimiters must start with a comment 

character "C" (for FORTRAN files). 

3. Each line of documentation must be less than or equal to 70 
characters (not counting the comment character.) 

4. Each line is passed verbatum into the document so that block 
formatting can be performed using tabs and spaces. 

5. The special symbols "Cname" and Cfig" di scribed above must 
start in column 1. 

Althouqh the formatting of documentation is arbitrary and therefore up 
to the programmer, in order for the final document to be consistent a 
documenting convention is required. In this document the following 
convention was adhered to: 
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File header documentation 

A/.iVA'A'/VA' Af Ai /VAT/V/V/VA^/V/V/VA'A* A/A'Af/VA'/V 

Cfi 1 

Cname: Name of the file. 

Ccont: Description of what the file contains. 

Csubr: List of subroutines with a one line description of each. 

Cendfil 


Subroutine and Program documentation 

/VA^A'A/A'<V/VA'A//VrtWA/^//V/ , /A/A//VA//V»VA'A^A^A//V/»/A'A/A//VA/A^A^/V 

Cdoc 

Cname: Name of subroutine or function (with optional enumeration of 

Mnemonics. ) 

Cfunc: Short description of how the subroutine functions. 

Ccall: Sample calling sequence. 

Cargs: List of arguments used in calling sequence along with a short 

definition and an indication of whether they are used as inputs 
outputs or both. 

Cints: List of key internal variables and there definitions. 

Crefs: List of subroutines referenced by the routine (with optional 

description of each.) 

Crefbv: List of the routines that reference this routine. 

Ccomm: List of the common blocks used by this routine (with optional 
description of each.) 

Cfig: FFPF(n) TITLE!...] 

Cenddoc 


Common block documentation 


C comb lk 

Cname: Name of the common block. 

Ccont: Purpose or contents of the common block. 

Cvars: List of variables along with a definition of each. 

Crefby: List of routines containing this common block 
Cendcom 


B-5 



GENERATING THE FINOS PROGRAMMERS MANUAL 


At this point the reader should have a basic understanding of how the 
automatic documentation system works, as well as how to add 
documentation to a Fortran source file (the reader is refered to C5] 
for a complete discussion of the DSR commands used to format the 
runoff file.) However, it is not yet clear what steps are required to 
generate the manual if additional documentation, and/or figures or 
tables are added or deleted. Basically the same steps mentioned at 
the start of this appendix apply, with the following exception: since 

OSR doesn't support the notion of lists of tables, figures, or 
references — they must be maintained by hand. This means that: 

1. If table or figure numbering is modified, all direct 

references to figures or tables by number must be updated to 
reflect the new sequence. This can be avoided if they are 
refered to by title or placement. 

2. The page numbers in the list of figures and the list of 
tables must be corrected. This is accomplished by simply 
running DSR once, noting the correct page numbers, correcting 
the runoff file, and re-running OSR. 

3. If references are added or subtracted from the manual, 
citations made in the body of the report must be corrected, 
as well as the list of references itself. 


In closing, the following observations are made as to the 
effectiveness of this method. On the positive side: 

1. The documentation is available inside the source file itself, 
therefore it is readily available for a programmer to 
reference. 

2. Documentation can be kept up to date by simply making an 
incremental addition to existing text. Moreover it can 
conveniently be done at the same time the code is altered - 
when the concept is clearest. 

3. Working documentation can be made available at any point in 
the development process. 

4. It's flexible. All documentation is stored electronically. 
Therefore, changes can be made without disturbing the overall 
structure, or compleatly re-drawing old figures to add minor 
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modifications. 


For all its stronq points, there are of course some weaknesses as 
wel 1 : 

1. DSR's lack of support for tables, figures, and references can 
create some extra maintainence effort. This could be 
eliminated if a more powerful text formatter where used, or 
if a pre-filter were written to do the maintainence 
automatical 1 y. 

2. Because the documentation is written in a decentralized 

fashion it can be discontinuous in style and notation, unless 
clearly defined rules are followed. 

3. If a correction in notation is desired several files must be 

modified, rather than a single one in the case of a more 

conventional document. 

4. Source files will, of course, be larqer if this method is 

used. This may be a concern if disk space is at a premium. 
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Common blocks 
cmpstf. 134 
dcidei, 134 
detinf. 135 
detsiq, 136 
detxbi. 136 
detvbi, 137 
ekbfO, 138 
fcoml, 138 
fcom2. 139 
filnam. 139 
filtic. 140 
filtrt, 140 
fltctl. 141 
ftltl 1. 142 
gblend, 143 
healcm. 143 
hfcom, 144 
initvl, 145 
inou, 145 
mainl, 146 
main2. 147 
multdt, 147 
senscm. 147 
simcom, 148 
smprm. 148 
stitl. 149 
sysul, 149 
sysxl. 150 
sysxbO, 151 
sysywl. 151 
yobsrv. 152 

Source f i les 

doc. rat, 17, 121 
fqac.for. 13. 85 


fio.for, 14, 86 
fmain.for, 11, 18 
f sens. for, 14, 86 
fsfdi.for, 11, 28 
futsub.for, 15, 92 
fvmsub.for, 16, 106 
fwind.for, 13, 85 
plotd.t'or, 17, 119 
printd.for, 17, 120 
Subroutines 
abslim. 92 
accvel, 92 
aditbp, 75 
asumer. 98 
avbias, 84 
avecmp, 82 
barnl. 104 
biasf. 41 
blend. 44 
blgain, 47 
bubble, 113 
chkfl. 88 
chkrad, 48 
ckunst. 36 
clpsbe, 73 
clpsio, 71 
convrf, 83 
decide, 64 
detect, 51 
dgatio, 97 
doc. 121 
dot, 114 
dot2. 114 
dot3, 114 
ekfnl, 38 
equate, 112 
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filed . 73 

finds - (main program!. 18 

f level. 89 

fsched. 87 

gauss. 105 

gminv. 106 

qtoi, 36 

qyrocr, 35 

healr, 77 

imtcg2. 102 

inital. 27 

initf. 32 

initg. 32 

insrtn. 116 

kalmn. 37 

limval. 103 

limvl2. 103 

lkf , 63 

lrt. 64 

lrthlr. 82 

maddl. Ill 

maddi , 111 

matl. 107 

matla. 108 

mat2. 108 

mat3. 109 

mat3a. 109 

mat4. 110 

mat5. 110 

mat6. Ill 

matcq2. 101 

matmul. 97 

matnul. 112 

mattv3, 96 

matv3. 96 

maxmin. 99 

maxmins. 99 

minset. 76 

mmul. 107 

mmul2, 107 


movum, 97 
mseale. 113 
mxmn2. 100 
namfil, 105 

nav (fault tolerant naviqatorl 
28 

noiseo. 104 
noisr. 72 
outdat, 90 
plotd. 119 
pntinv, 102 
printd, 120 
prntic. 87 
rcov. 75 
reconf, 65 
resemp. 73 
rotatv, 93 
rotmat, 93 
rungk3, 94 
runway, 94 
savit. 86 
seqnce, 116 
set. 27 
setisn. 47 
setum. 95 
startf. 33 
sumin, 34 
summer. 98 
sumout. 34 
swap. 118 
tlout. 90 
trans2. 113 
unifrm. 105 

upda. 48 
updab. 49 

updb. 49 
updh. 51 
updph, 51 
updq, 50 
vadd. 115 
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vaddl. 115 
vechql. 100 
vecm, 95 
vecms, 95 
vecnul. 117 


vecnuls. 117 
vecsum, 96 
vmatl, 118 
vmat2. 118 
vscale, 116 
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